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[Name of Document] Description 

[Title of the Invention] Support system, and 
computer- readable recording medium in which embedded [sic] 
support program is recorded 
5 [Scope of Claims] 

[Claim 1] A support system comprising: 
a mechanism designing section for 
three-dimens ionally designing a mechanism composed of a 
plurality of parts including an actuator and a sensor; 
10 a three-dimensional-mechanism model simulating 

section, in which the mechanism is structured as a 
three-dimensional-mechanism model, for simulating an 
operation of the mechanism; 

an embedded software developing section for 
15 developing a control program, which is embedded in the 
mechanism to control the operation of the mechanism, as 
embedded software ; 

a first interface section for inputting designing 
data, which is created in said mechanism designing section 
20 as the result of the designing by said mechanism designing 
section, from said mechanism designing section to said 
three-dimensional-mechanism model simulating section to 
be reflected on the three-dimensional -mechanism model ; and 
a second interface section for transferring data 
25 between said three-dimensional-mechanism model 

simulating section and said embedded software developing 
section while synchronizing said 
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three-dimensional-mechanism model simulating section and 
said embedded software developing section in operation with 
each other. 

[Claim 2] A support system according to claim 1, 
5 wherein said first interface section inputs the result of 
the simulating by said three-dimensional-mechanism model 
simulating section from said three-dimensional-mechanism 
model simulating section to said mechanism designing 
section to be reflected on the designing of the mechanism. 
10 [Claim 3] A support system according to claim 1 or 

2, wherein: 

said embedded software developing section includes 
a status- transition diagram or table creating section for 
creating and editing a status- transition diagram or table 
15 describing specifications of the embedded software to 
execute detailed designing of the embedded software; and 
said second interface section transfers data between 
said three-dimensional-mechanism model simulating 
section and said status- transit ion diagram or table 
20 creating section while synchronizing said 

three-dimensional-mechanism model simulating section and 
said status-transition diagram or table creating section 
in operation with each other. 

[Claim 4] A support system according to claim 3, 
25 wherein: 

said status- transition diagram or table creating 
section employs a multi-task, which executes a plurality 
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of tasks in parallel to one another, and executes, 
separately from the plural tasks, a synchronous task 
functioning so as to stop the plural tasks during the 
simulation operation of said three-dimensional-mechanism 
5 model simulating section; and 

said second interface section synchronizes said 
three-dimensional-mechanism model simulating section and 
said status-transition diagram or table creating section 
in operation with each other using the synchronous task. 

10 [Claim 5] A support system according to claim 4, 

wherein the synchronous task is set to a highest priority 
to control starting/ stopping of the plural tasks in 
accordance to the synchronous task to thereby synchronize 
said three-dimensional-mechanism model simulating 

15 section and said status- transition diagram or table 
creating section in operation with each other 

[Claim 6] A support system according to any one of 
claims 1 to 5, wherein: 

said embedded software developing section includes 

20 a microcomputer chip in which said embedded software is 
embedded during the developing; and 

said second interface section transfers data between 
said three-dimensional-mechanism model simulating 
section and said microcomputer chip while synchronizing 

25 said three-dimensional-mechanism model simulating 

section and said microcomputer chip in operation with each 
other. 
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[Claim 7] A support system according to claim 6, 
wherein : 

said microcomputer chip employs a multi-task, which 
5 executes a plurality of tasks in parallel to one another, 
and executes, separately from the plural tasks, a 
synchronous task functioning so as to stop the plural tasks 
during the simulation operation of said 

three-dimensional-mechanism model simulating section; 
10 and 

said second interface section synchronizes said 
three-dimensional-mechanism model simulating section and 
said microcomputer chip in operation with each other using 
the synchronous task. 

15 [Claim 8] A support system according to claim 7, 

wherein said three-dimensional-mechanism model 
simulating section and said microcomputer chip are 
synchronized in operation with each other by setting the 
synchronous task to a highest priority to control 

20 starting/stopping of the plural tasks in accordance to the 
synchronous task. 

[Claim 9] A support system according to any one of 
claims 1 to 8, wherein said second interface section 
trans fers : 

25 an actuator instruction signal for the actuator in 

the three-dimensional-mechanism model from said embedded 
software developing section to said 
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three-dimensional-mechanism model simulating section; 
and 

a sensor signal, which is obtained as the result of 
simulation in response to said actuator instruction signal , 
5 from said three-dimensional-mechanism model simulating 
section to said embedded software developing section. 

[Claim 10] A support system according to claim 9, 
further comprising an analyzing section for analyzing and 
displaying variation of said actuator instruction signal 
10 for the actuator and said sensor signal from said 

three-dimensional-mechanism model s imulating section 
with real time. 

[Claim 11] A computer-readable recording medium in 
which a support program to realize, on a computer, a function 
15 of assisting a development of embedded software to be 
embedded in a mechanism, composed of a plurality of parts 
including an actuator and a sensor, as a control program 
to control the mechanism is recorded, said support program 
comprises : 

20 a mechanism designing program for instructing the 

computer to function as a mechanism designing section which 
designs the mechanism three-dimensionally ; 

a three-dimensional-mechanism model simulating 
program for instructing the computer to function as a 

25 three-dimensional-mechanism model simulating section, in 
which the mechanism is structured as a 

three-dimensional-mechanism model, for simulating an 
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operation of the mechanism; 

an embedded software developing program for 
instructing the computer to function as an embedded 
software developing section which develops the embedded 
5 software; 

a first interface program for instructing the 
computer to function as a first interface section for 
inputting designing data, which is created in said 
mechanism designing section as the result of the designing 

10 by said mechanism designing section, from the mechanism 
designing section to the three-dimensional-mechanism 
model simulating section to be reflected on the 
three-dimensional-mechanism model; and 

a second interface program for instructing the 

15 computer to function as a second interface section which 
transfers data between the three-dimensional-mechanism 
model simulating section and the embedded software 
developing section while synchronizing the 
three-dimensional-mechanism model simulating section and 

20 the embedded software developing section in operation with 
each other. 

[Claim 12] A computer-readable recording medium 
according to claim 1 [sic], wherein said first interface 
program inputs the result of the simulating by said 
25 three-dimensional-mechanism model simulating section 

from said three-dimensional-mechanism model simulating 
section to said mechanism designing section to be reflected 



6 



on the designing of the mechanism. 

[Claim 13] A computer-readable recording medium 
according to claim 11 or 12, wherein: 

said embedded software developing program includes 
5 a status-transition diagram or table creating program 
instructing the computer to function as a status-transition 
diagram or table creating section for creating and editing 
a status-transition diagram or table describing 
specifications of the embedded software to execute detailed 
10 designing of the embedded software; and 

said second interface program transfers data between 
said three-dimensional-mechanism model simulating 
section and said status- trans it ion diagram or table 
creating section while synchronizing said 
15 three-dimensional-mechanism model simulating section and 
said status-transition diagram or table creating section 
in operation with each other. 

[Claim 14] A computer-readable recording medium 
according to claim 13, wherein: 
20 said status- transition diagram or table creating 

program employs a multi-task, which executes a plurality 
of tasks in parallel to one another, and executes, 
separately from the plural tasks, a synchronous task 
functioning so as to stop the plural tasks during the 
25 simulation operation of said three-dimensional-mechanism 
model simulating section; and 

said second interface program synchronizes said 
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three-dimensional-mechanism model simulating section and 
said status-transition diagram or table creating section 
in operation with each other using the synchronous task. 



5 [Claim 15] A computer-readable recording medium 

according to claim 14, wherein said 

three-dimensional-mechanism model simulating section and 
said status-transition diagram or table creating section 
are synchronized in operation with each other by setting 

10 the synchronous task to a highest priority to control 
starting/stopping of the plural tasks in accordance to the 
synchronous task. 

[Claim 16] A computer-readable recording medium 
according to any one of claims 11 to 15, wherein said second 

15 interface program transfers data between said 

three-dimensional-mechanism model simulating section and 
a microcomputer chip, in which said embedded software being 
developed is embedded, while synchronizing said 
three-dimensional-mechanism model simulating section and 

20 said microcomputer chip in operation with each other. 

[Claim 17] A computer-readable recording medium 
according to claim 16, wherein: 

said microcomputer chip employs a multi-task, which 
executes a plurality of tasks in parallel to one another, 

25 and executes, separately from the plural tasks, a 

synchronous task functioning so as to stop the plural tasks 
during the simulation operation of said 
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three-dimensional-mechanism model simulating section; 
and 

said second interface program synchronizes said 
three-dimensional-mechanism model simulating section and 
5 said microcomputer chip in operation with each other using 
the synchronous task. 

[Claim 18] A computer-readable recording medium 
according to claim 17, wherein said synchronous task is 
set to a highest .prior ity to control start ing/ stopping of 
10 the plural tasks in accordance to the synchronous task to 
thereby synchroni ze said three-dimensional-mechanism 
model simulating section and said microcomputer chip in 
operation with each other. 
[Detailed Description of the Invention] 
15 [0001] 

[Technical Field Pertinent to the Invention] 
The present invention generally to a technology of 
designing and developing a mechanism which includes an 
actuator and a sensor andmakes a three-dimensional motion, 

20 and more particularly to a support system for supporting 
the development of a control program (embedded software) 
to be embedded in the mechanism to control the mechanism. 
The invention relates also to a computer-readable recording 
medium in which a support program is recorded. 

25 [0002] 

[Conventional Art ] 

Generally, when designing a mechanism which includes 
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an actuator (motor) and a sensor and makes a 
three-dimensional motion, firstly a plan for the mechanism 
is made, and then detail designing, preparation of drawings, 
and preparation of parts are followed, whereupon a real 
5 mechanism is assembled of the prepared parts as a trial 
product and then motions, for example, of the trial product 
are evaluated. And design changing is made according to 
the result of evaluation, and then a modified trial product 
is assembled based on the design changing, whereupon 

10 motions, for example, of the modified trial product is 
evaluated. This procedure is repeated until a good result 
of evaluation is obtained, which requires no further design 
change, completing designing. The term "mechanism" means 
any mechanism exemplified by CD changer, MD changer, 

15 printer, and manipulator. 
[0003] 

More specifically, for moving the thus designed 
mechanism, a control program to control the mechanism is 
developed. The control program is executed by a 
20 prospective microcomputer to be actually embedded in the 
mechanism to be controlled. The control program to be 
executed by the microcomputer is hereinafter also called 
"embedded software" . 
[0004] 

25 According to the conventional art, by the time the 

control program (embedded software) is developed, a trial 
product (real mechanism) of an object mechanism to be 



control had been completed. Namely, the mechanism cannot 
be practically moved until after completion of the trial 
product. Evaluation data is collected as the mechanism 
is practically moved, based on which developing of embedded 
5 software can be started. 

The developing of this embedded software is carried 
out in the following procedure while the trial product is 
actually moved . Firstly outline designing of prospective 
embedded software is made, and then detail designing is 
10 made based on the outline designing, whereupon the result 
of the detail designing is coded to create the embedded 
software. Finally the created embedded software is 
debugged . 
[0005] 

15 [Problems to be Solved by the Invention] 

However, as mentioned above, since a trial product 
(real mechanism) of the object mechanism to be controlled 
is inevitable to develop embedded software (control 
program) , the embedded software developing cannot be 
20 started until after completion of the trial product, which 
would be money- and time-consuming. 
[0006] 

Yet if the embedded software developing could be 
started using the completed trial product, such developing 
25 would encounter repetitious design changing of the trial 
product depending on the result of evaluation. As the 
embedded software developing is thus often interrupted, 
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trial products have to be completed one at each occurrence 
of design changes . After completion of each and every trial 
product, specifications changes and recoding are required 
for each trial product due to the individual design change, 
which would cause an extremely inefficient development of 
embedded software . 
[0007] 

In the conventional art, as mentioned above, there 
appears no concurrency between designing of mechanism 

(manufacturing of real mechanism) and developing of 
embedded software for the mechanism, so they could not be 
executed simultaneously. Consequently a technology has 
been cherished to accomplish designing of an object 
mechanism and developing of embedded software in parallel . 

[0008] 

With the foregoing problems in view, an object of 
the present invention is to provide a support system which 
enables to accomplish designing of an object mechanism and 
developing of embedded software, which controls the 
mechanism, concurrently (in parallel) to increase the 
developing efficiency, thus shorting term of software 
development and reducing the number of steps, and to provide 
a computer-readable recording medium in which a support 
system [sic] is recorded. 
[0009] 

[Means for Solving the Problem] 

In order to attain the object, according to a first 
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generic feature of the invention, there is provided a 
support system (claim 1) comprising: a mechanism designing 
section for three-dimensionally designing a mechanism 
composed of a plurality of parts including an actuator and 
5 a sensor; a three-dimensional-mechanism model simulating 
section, in which the mechanism is structured as a 
three-dimensional-mechanism model, for simulating an 
operation of the mechanism; an embedded software developing 
section for developing a control program, which is embedded 

10 in the mechanism to control the operation of the mechanism, 
as embedded software; a first interface section for 
inputting designing data, which is created in the mechanism 
designing section as the result of the designing by the 
mechanism designing section, from the mechanism designing 

15 section to the three-dimensional-mechanism model 
simulating section for being reflected on the 
three-dimensional-mechanism model ; and a second interface 
section for transferring data between the 
three-dimensional-mechanism model simulating section and 

20 the embedded software developing section while 

synchroni zing the three-dimensional-mechanism model 
simulating section and the embedded software developing 
section in operation with each other. 
[0010] 

25 Preferably, the first interface section inputs the 

result of the simulating by the 

three-dimensional-mechanism model simulating section 

13 



from the three-dimensional-mechanism model simulating 
section to the mechanism designing section for being 
reflected on the designing of the mechanism (claim 2). 

As another preferred feature, the embedded software 
5 developing section includes a status-transition diagram 
or table creating section for creating and editing a 
status-transition diagram or table describing 
specifications of the embedded software to execute detailed 
designing of the embedded software; and the second 
10 interface section transfers data between the 

three-dimensional-mechanism model simulating section and 
the status- transition diagram or table creating section 
while synchroni zing the three-dimensional-mechanism 
model simulating section and the status-transition diagram 
15 or table creating section in operation with each other 
( claim 3 ) . 
[0011] 

As still another preferred feature, the 
status-transition diagram or table creating section 

20 employs a multi-task, which executes a plurality of tasks 
in parallel to one another, and executes, separately from 
the plural tasks, a synchronous task functioning so as to 
stop the plural tasks during the simulation operation of 
the three-dimensional-mechanism model simulating 

25 section; and the second interface section synchronizes the 
three-dimensional-mechanism model simulating section and 
the status- transit ion diagram or table creating section 
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in operation with each other using the synchronous task 
(claim 4). Further, the synchronous task is set to a 
highest priority to control start ing/ stopping of the plural 
tasks in accordance to the synchronous task to thereby 
synchronize the three-dimensional-mechanism model 
simulating section and the status- transition diagram or 
table creating section in operation with each other (claim 

5) . 

[0012] 

As a further preferred feature, the embedded software 
developing section includes a microcomputer chip in which 
the embedded software is embedded during the developing; 
and the second interface section transfers data between 
the three-dimensional-mechanism model simulating section 
and the microcomputer chip while synchronizing the 
three-dimensional-mechanism model simulating section and 
the microcomputer chip in operation with each other (claim 

6) . 

[0013] 

As an additional preferred feature, the 
microcomputer chip employs a multi-task, which executes 
a plurality of tasks in parallel to one another, and executes , 
separately from the plural tasks, a synchronous task 
functioning so as to stop the plural tasks during the 
simulation operation of the three-dimensional-mechanism 
model simulating section; and the second interface section 
synchronizes the three-dimensional-mechanism model 
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simulating section and the microcomputer chip in operation 
with each other using the synchronous task (claim 7). 
Further, the three-dimensional-mechanism model 
simulating section and the microcomputer chip are 
5 synchronized in operation with each other by setting the 
synchronous task to a highest priority to control 
start ing/ stopping of the plural tasks in accordance to the 
synchronous task (claim 8) . 
[0014] 

10 As a further preferred feature, the second interface 

section transfers: an actuator instruction signal for the 
actuator in the three-dimensional-mechanismmodel from the 
embedded software developing section to the 
three-dimensional-mechanism model simulating section; 

15 and a sensor signal, which is obtained as the result of 
simulation in response to the actuator instruction signal, 
from the three-dimensional-mechanism model simulating 
section to the embedded software developing section (claim 
9) . 

20 [0015] 

As a still further preferred feature, the support 
system further comprises an analyzing section for analyzing 
and displaying variation of the actuator instruction signal 
for the actuator and the sensor signal from the 
25 three-dimensional-mechanism model simulating section 
with real time (claim 10). 

In order to attain the second object, according to 
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a second generic feature of the invention, there is provided 
a computer-readable recording medium (claim 11) in which 
a support program to realize, on a computer, a function 
of assisting a development of - embedded software to be 
5 embedded in a mechanism, composed of a plurality of parts 
including an actuator and a sensor, as a control program 
to control the mechanism is recorded, the support program 
comprises: (1) a mechanism designing program for 
instructing the computer to function as a mechanism 

10 designing section which designs the mechanism 

three-dimens ionally ; (2) a three- dimensional -mechanism 
model simulating program for instructing the computer to 
function as a three-dimensional-mechanism model 
simulating section, in which the mechanism is structured 

15 as a three-dimensional-mechanism model , for simulating an 
operation of the mechanism; (3) an embedded software 
developing program for instructing the computer to function 
as an embedded software developing section which develops 
the embedded software; (4) a first interface program for 

20 instructing the computer to function as a first interface 
section for inputting designing data, which is created in 
the mechanism designing section as the result of the 
designing by the mechanism designing section, from the 
mechanism designing section to the 

25 three-dimensional-mechanism model simulating section for 
being reflected on the thr ee- dimensional -me chani sm model; 
and (5) a second interface program for instructing the 
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computer to function as a second interface section which 
transfers data between the three-dimensional-mechanism 
model simulating section and the embedded software 
developing section while synchronizing the 
5 three-dimensional-mechanism model simulating section and 
the embedded software developing section in operation with 
each other. 
[0016] 

Preferably, the first interface program inputs the 

10 result of the simulating by the 

three-dimensional-mechanism model s imulat ing section 
from the three-dimensional-mechanism model simulating 
section to the mechanism designing section for being 
reflected on the designing of the mechanism (claim 12) . 

15 As another preferred feature, the embedded software 

developing program includes a status-transition diagram 
or table creating program instructing the computer to 
function as a status- transit ion diagram or table creating 
section for creating and editing a status- transit ion 

20 diagram or table describing specifications of the embedded 
software to execute detailed designing of the embedded 
software; and the second interface program transfers data 
between the three-dimensional-mechanism model simulating 
section and the status-transition diagram or table creating 

25 section while synchronizing the 

three-dimensional-mechanism model simulating section and 
the status- transition diagram or table creating section 

18 



in operation with each other (claim 13) . 
[0017] 

As still another preferred feature, the 
status- transition diagram or table creating program 
5 employs a multi-task, which executes a plurality of tasks 
in parallel to one another, and executes, separately from 
the plural tasks, a synchronous task functioning so as to 
stop the plural tasks during the simulation operation of 
the three-dimensional-mechanism model simulating 

10 section; and the second interface program synchronizes the 
three-dimensional-mechanism model simulating section and 
the status-transition diagram or table creating section 
in operation with each other using the synchronous task 
(claim 14), Further, the three-dimensional-mechanism 

15 model simulating section and the status- trans it ion diagram 
or table creating section are synchronized in operation 
with each other by setting the synchronous task to a highest 
priority to control start ing/ stopping of the plural tasks 
in accordance to the synchronous task (claim 15). 

20 [0018] 

As a further preferred feature, the second interface 
program transfers data between the three-dimensional- 
mechanism mo del simulating section and a microcomputer chip, 
in which the embedded software being developed is embedded, 
25 while synchronizing the three-dimensional-mechanism 

model simulating section and the microcomputer chip in 
operation with each other (claim 16) . 



[0019] 

As an additional preferred feature, the 
microcomputer chip employs a multi-task, which executes 
aplurality of tasks inparallel to one another, and executes, 
5 separately from the plural tasks, a synchronous task 
functioning so as to stop the plural tasks during the 
simulation operation of the three-dimensional-mechanism 
model simulating section; and the second interface program 
synchronizes the three-dimensional-mechanism model 

10 simulating section and the microcomputer chip in operation 
with each other using the synchronous task (claim 17). 
Further, the synchronous task is set to a highest priority 
to control starting/ stopping of the plural tasks in 
accordance to the synchronous task to thereby synchronize 

15 the three-dimensional-mechanism model simulating section 
and the microcomputer chip in operation with each other 
(claim 18) . 
[0020] 

[Mode for Carrying out the Invention] 
20 Preferred embodiments of the present invention will 

now be described with reference to the accompanying 
drawings . 

FIG. 3 is a schematic, perspective view of a computer 
system in which the support system of the first embodiment 
25 can be architected. 

As shown in FIG. 3, the computer system 100 comprises, 
as fundamental components, a system cabinet 101, in which 

20 



a CPU 221, an RAM 222, a hard disc 211, etc. are mounted 
as described later with reference to FIG. 4, a CRT display 
102 for displaying on a screen 102a in response to an 
instruction from the system cabinet 101, a keyboard 103 
5 for inputting a user's instructions and character 

information to the computer system 100, and a mouse 104 
for inputting an instruction corresponding to an icon or 
. the like, which is displayed on the display screen 102a 
at an arbitrary position, by designating the position. 
10 [0021] 

The system cabinet 101 further has, on its exterior 
side, a floppy disk loading port 101a and a CD-ROM loading 
port 101b from which a floppy disk 212 (FIG. 4) and a CD-ROM 
210 are removably loaded. And inside the system cabinet 
15 101, a floppy disc driver 224 and a CD-ROM driver 225 (FIG. 
4 ) are mounted to drive the loaded floppy disc 212 and CD-ROM 
210, respectively. 
[0022] 

In the CD-ROM (hereinafter also called "computer- 
20 readable recording medium") 210, a support program 300 
[sic] (FIG. 2) according to the first embodiment is 
prewritten . 

The CD-ROM 210 is loaded in the system cabinet 101 
from the CD-ROM loading port 101b, and then the support 
25 program 300 [sic] recorded in the CD-ROM 210 is installed 
in the hard disc 211 of the computer system 100 by the CD-ROM 
driver 225. 
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[0023] 

Further, in the hard disc 211 of the computer system 
100, designing data of an object mechanism, which is 
designed and defined by a mechanism designing section 
5 (hereinafter also called "transport [sic] and 

three-dimensional CAD system") 20 described later with 
reference to FIG. 1, is stored. Based on the designing 
data, a three-dimensional mechanism model can be 
architected for the mechanism in the computer system 100 
10 (a later-described three-dimensional real-time simulator 
30) . 
[0024] 

Furthermore, in the hard disc 211 of the computer 
system 100, a control program (hereinafter also called 

15 "embedded software") developed by an embedded software 
developing section 40, which will be described later with 
reference to FIG. 1, is stored. In the hard disc 211, not 
only the embedded software whose development has been 
completed is stored, but also the embedded software being 

20 developed is stored and preserved. 
[0025] 

FIG. 4 is a block diagram showing hardware of a 
computer system in which the support system of the first 
embodiment can be architected. As shown in FIG. 4, in the 
25 computer system 100 of the present embodiment, the central 
processing unit (CPU) 221, the RAM 222, a hard disc 
controller 223, the floppy disc driver 224, the CD-ROM 



driver 225, a mouse controller 226, a keyboard controller 
227, a display controller 228, a modem 229, and a ROM 230 
are interconnected via a bus line 220. 
[0026] 

The floppy disc driver 224 and the CD-ROM driver 225, 
as described above in connection with FIG. 3, respectively 
take access to the floppy disc 212 and the CD-ROM 210 when 
loaded . 

The hard disc controller 223 controls the hard disc 
211 and take access to the hard disc 211 in accordance with 
an instruction from the CPU 221 . The mouse controller 226 
serves as an interface between the mouse 104 and the computer 
system 100; and the keyboard controller 227, an interface 
between the keyboard 103 and the computer system 100. And 
the display controller 228 controls the display status of 
the CRT display 102 in accordance with a control signal 
from the CPU 221. 
[0027] 

Further, the modem 229 is connected to a 
non-illustrated communications circuit for 
communications with another computer system that is 
identical in construction with that of FIGS. 3 and 4. 

As described above, the support program 300 [sic] 
(FIG. 2) is prewritten or prerecorded in the CD-ROM 210 
for being read out from the CD-ROM 210 by the CD-ROM driver 
225 and being stored in the hard disc 211 via the bus line 
220 by the hard disc controller 223. Practically, the 
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support program 300 [sic] in the hard disc 211 is loaded 
onto the RAM 222 and is executed by the CPU 221. 
[0028] 

The support program 300 [sic] realizes an embedding 
5 support system 10 of FIG. 1 in the following manner. As 
the CPU 221 executes the support program 300 [sic] in RAM 
222 via the bus line 220, the respective functions 
(described later in detail) of a mechanism designing 
section 20, a three-dimensional real-time simulator 30, 
10 a status-transition diagram or table creating/ edit ing 
section 41, an integrated developing environment [sic] 43 
and interface sections 50-52, which jointly constitute the 
support system 10, is realized. 
[0029] 

15 The support program 300 [sic] is provided in a form 

recorded in a computer-readable recording medium 300, such 
as CD-ROM (210) or a flexible disc (floppy disc 212) as 
described above. The computer system 100, as described 
above, reads out the program 300 [sic] from the recording 

20 medium and transfers it to an internal storage of the hard 
disc 211 or an external storage to store for use. 
Alternatively, the program 300 [sic] may be recorded in 
a storage (recording medium) , such as a magnetic disc, an 
optical disc or a magneto-optical disc, for being provided 

25 from the storage to the computer system 100 via a 
communications line and the modem 229. 
[0030] 
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The recording medium of the first embodiment may be 
various kinds of computer-readable media, which are 
exemplified by flexible disc, CD-ROM, magnet disc, optical 
disc, magneto-optical disc, IC card, ROM cartridge, 
magnet ic tape , punched card, internal storage (memory such 
asRAMorROM) of the computer , external storage , andprinted 
matter labeled with code, e.g., bar code. 
[0031] 

The support system 10 of the present embodiment to 
be realized by the computer system 100 of FIG. 4 supports 
in developing a control program (embedded software) to be 
embedded in a mechanism, which has at least one actuator 
and at least one sensor and makes a three-dimensional 
movement, to control the mechanism during designing and 
developing of the mechanism. 

For this purpose, the support system 10 of the present 
embodiment not only has the respective functions as the 
mechanism designing section 20, the three-dimensional 
real-time simulator 30, the status- trans it ion diagram or 
table creating/editing section 41, the integrated 
developing environment section 43, and the interface 
sections 50-52, but also includes a microcomputer chip 42 
in which the embedded software having been developed is 
stored to control the mechanism. 
[0032] 

FIG. 1 is a block diagram showing the functional 
structure of a support system 10 according to the first 
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embodiment of the present invention. 

The support system 10 of the present embodiment 
performs designing of a mechanism and developing of 
embedded software concurrently (in parallel) and, for this 
5 purpose, is generally divided into the mechanism designing 
section 20, the three-dimensional real-time simulator 30, 
and the embedded software developing section 40. 
[0033] 

The mechanism designing section (appearance design 
10 and three-dimensional CAD system, and mechani sm des igning 
section) 20 three-dimensional ly designs a mechanism that 
is composed of a plurality of parts including an actuator 
and a sensor. The cooperation of the mechanism designing 
section 20 and the three-dimensional real-time simulator 
15 30 will be described later in detail with reference to FIGS. 
5 and 6 . 

The three-dimensional real-time simulator 
(hereinafter also called "three-dimensional -mechanism 
model simulating section") 30 architects in it the 

20 mechanism, which is designed by the mechanism designing 
section 20, as a three-dimensional-mechanism model, and 
simulates movements of the mechanism. The 
three-dimensional real-time simulator 30 will be described 
later in detail with reference to FIGS . 17 through 82. 

25 [0034] 

The embedded software developing section 40 develops, 
in parallel to designing of the mechanism by the mechanism 
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designing section 20, a control program to be embedded in 
the mechanism, as embedded software, for controlling the 
movement of the mechanism. 

Further, in the support system 10 of the present 
5 embodiment, which is equipped with the interface sections 
5 0-52 , the embedded software developing section 4 0 includes 
the status-transition diagram or table creating/editing 
section 41, the microcomputer chip 42, and the integrated 
developing environment section 43. 
10 [0035] 

The interface section (first interface section) 50 
serves to input designing data, which is designed by the 
mechanism designing section 20, from the mechanism 
designing section 20 to the three-dimensional real-time 

15 simulator 30 for being dynamically reflected on the 
three-dimensional-mechanism model, which is to be 
architected in the three-dimensional real-time simulator 
30. The first interface section 50 serves also to input 
the result of simulation by the three-dimensional real-time 

20 simulator 30 from the three-dimensional real-time 

simulator 30 to the mechanism designing section 20. 
[0036] 

The function of the first interface section 50 may 
be incorporated wholly in either one of the mechanism 
25 designing section 20 and the three-dimensional real-time 
simulator 30, or may be incorporated separately in the 
mechanism designing section 20 and the three-dimensional 
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real-time simulator 30. 

The other interface section (second interface 
sections) 51, 52 each serve to receive data from the 
three-dimensional real-time simulator 30 and transmit the 
5 data to the embedded software developing section 40 and 
vice versa, while establishing synchronization in 
operation between the three-dimensional real-time 
simulator 30 and the embedded software developing section 
40 . 
10 [0037] 

Further, the embedded software developing software 
section 4 0 in the support system 10 of the present embodiment 
includes the status- transition diagram or table 
creating/editing section (hereinafter also called 

15 "status-transition diagram or table creating section") 41, 
the microcomputer chip 42, and the integrated developing 
environment section 43. 

The status- transit ion diagram or table creating/ 
editing section 41 describes specifications of embedded 

20 software for detailed designing of the embedded software 
and creates a task control flow for the embedded software. 
The detail of the status-transition diagram or table 
creating/editing section 41 and the detail cooperation 
between the status-transition diagram or table 

25 creating/editing section 41 and the three-dimensional 
real-time simulator 30 will be described later in detail 
with reference to FIGS. 7 through 14. 
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[0038] 

Embedded software being developed is embedded in the 
microcomputer chip 4 2 , and the resultant microcomputer chip 
42 is actually loaded on the mechanism to control the 
5 operation of the mechanism. The integrated developing 
environment section 43 converts a task control flow from 
the status- transition diagram or table creating/editing 
section 41 into C, C++, and assembler coding (by coding 
or code generation) , and creates an executing module for 
10 a target microcomputer (i.e./ embedded software to be 
written into the microcomputer chip 42) . 
[0039] 

And the second interface section 51 receives data 
from the three-dimensional real-time simulator 30 and 

15 transmits the data to the status- transition diagram or 
table creating/ edit ing section 41 and vice versa, while 
establishing synchronization in operation between the 
three-dimensional real-time simulator 30 and the 
status-transition diagram or table creating/editing 

2 0 section 4 1 . 

In the first embodiment, as described later with 
reference to FIGS. 10 through 14, the status-transition 
diagram or table creating/editing section 41 adopts a 
multi-task for executing a plurality of tasks in parallel, 

25 and executes a synchronous task, apart from the plural task, 
for stopping the plural tasks during the simulation 
operation of the three-dimensional real-time simulator 30 . 
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Using the synchronous task, the second interface section 
51 synchronizes the operations of the three-dimensional 
real-time simulator 30 and the status-transition diagram 
or table creating/editing section 41. 
5 [0040] 

At that time, the second interface section 51 sets 
the priority of the synchronous task to a highest to control 
the starting and stopping of the plural tasks by the 
resultant synchronous task, thereby establishing 
10 synchronization in operation between the 

three-dimensional real-time simulator 30 and the 
status- transition diagram or table creating/editing 
section 4 1 . 

The function of the second interface section 51 may 
15 be incorporated wholly in the three-dimensional real-time 
simulator 30 and the status-transition diagram or table 
creating/editing section 41, or may be incorporated 
separately in the three-dimensional real-time simulator 
30 and the status-transition diagram or table 
20 creating/editing section 41. 
[0041] 

The other second interface section 52 serves to 
receive data from the three-dimensional real-time 
simulator 30 and transmit the data to the microcomputer 
25 chip 42 and vice versa, while establishing synchronization 
in operation between the three-dimensional real-time 
simulator 30 and the microcomputer chip 42. 
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In the first embodiment, the microcomputer chip 42, 
like the status-transition diagram or table 
creating/editing section 41, adopts a multi-task for 
executing a plurality of tasks in parallel, and executes 
5 a synchronous task, apart from the plural task, for stopping 
the plural tasks during the simulation operation of the 
three-dimensional real-time simulator 30. Using the 
synchronous task, the other second interface section 52 
synchronizes the operations of the three-dimensional 
10 real-time simulator 30 and the microcomputer chip 42. 
[0042] 

At that time, the other second interface section 52, 
like the one second interface section 51, sets the priority 
of the synchronous task to a highest to control the starting 

15 and stopping of the plural tasks by the resultant 

synchronous task, thereby establishing synchronization in 
operation between the three-dimensional real-time 
simulator 30 and the microcomputer chip 42. 

The function of the other second interface section 

20 52 may be incorporated wholly in either one of the three- 
dimensional real-time simulator 30 and the microcomputer 
chip 42, or may be incorporated separately in the 
three-dimensional real-time simulator 30 and the 
microcomputer chip 42 . 

25 [0043] 

In the support system 10 of the present embodiment, 
the second interface sections 51, 52 respectively transfer 



an actuator instruction signal for the actuator in the 
three-dimensional-mechanism model from the 
status- trans it ion diagram or table creating/editing 
section 41 and the microcomputer chip 42 to the 
5 three-dimensional real-time simulator 30, and a sensor 
signal, which is from the sensor in the 
three-dimensional-mechanism model, from the 
three-dimensional real-time simulator 30 to the 
status-transition diagram or table creating/editing 
10 section 41 and the microcomputer chip 42. 
[0044] 

The three-dimensional real-time simulator 30 may be 
equipped with a logic analyzer (analyzing section of FIG. 
15) . The logic analyzer analyzes a change with real time 

15 between the actuator instruction signal for the actuator 
and the sensor signal obtained by the three-dimensional 
real-time simulator 30, and displays the analyzed change 
with real time so that a developing person who develops 
the. embedded software can confirm the change with time. 

20 [0045] 

Further, the support system 10 may be equipped with 
an interface unit to connect a two-dimensional operation 
panel architecting unit with the three-dimensional 
real-time simulator 30 so that the 
25 three-dimensional-mechanism model can be operated on the 
two-dimensional operation panel on an interactive basis. 
In this case, on the two-dimensional operation panel, the 
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images of various switches or the like actually disposed 
on the microcomputer chip 42 is displayed. And when the 
embedded-software developing person designates the switch 
images on the two-dimensional operation panel, the 
5 three-dimensional real-time simulator 30 can perform the 
simulation as if the switches or the like on the 
microcomputer chip 42 are actually operated. 
[0046] 

In addition, the three-dimensional real-time 
1 0 simulator 30 of thepresent embodiment includes a mechanism 
model creating unit for creating models of various kinds 
of mechanisms, such as gears, cam, groove, clutch, roller 
and ratchet, and another mechani sm model creating unit for 
creating models of various kinds of mo tor s / sensor s , such 
15 as DC motor, stepping motor, AC motor, micro swi tch/opt ical 
switch, encoder, and pot ent iome ter . Using these mechanism 
model creating units , it is possible to express a mechanism, 
which is composed of various mechanisms and various 
motors/sensors in an arbitrary combination, as a 
20 three-dimensional-mechanism model . 
[0047] 

In the meantime, FIG* 2 is a diagram showing the 
architecture of a support program 310 that is recorded in 
the computer-readable recording medium 300 of the present 
2 5 embodiment. 

The recording medium 300 of FIG. 2 typically show 
the CD-ROM 210 in which the support program 310 is recorded, 
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the hard disc 211 in which the support program 310 is 
installed, the floppy disc212 or RAM 222 to which the support 
program 310 is downloaded, or ROM 230 in which the support 
program 31 0 is permanently recorded . The recording medium 
300 is a multiple form composed of a plurality of individual 
recording media interconnected by a communications line 
or the like, in which media a plurality of individual 
programs 311-316 constituting the support programs 310 are 
separately recorded . 
[0048] 

The support program 310 recorded in the recording 
medium 300 realizes, on the computer system 100 of FIGS. 
3 and 4, the function of the support system 10 of FIG. 1, 
namely, a function of assist the developing of embedded 
software to be embedded in a mechanism, which is composed 
of various parts including an actuator and a sensor, as 
a control program to control the mechanism. For this 
purpose, the support program 310 comprises a mechanism 
designing program 311, a three-dimensional-mechanism 
model simulating program 312, an embedded software 
developing program 313, a first interface program 314, a 
second interface program 315, and an integrated developing 
environment program 316. 
[0049] 

The mechanism designing program 311 renders the 
computer system 100 to function as the above-mentioned 
mechanism designing section 20, and the 
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three-dimensional-mechanism model simulating program 312 
renders the computer system 100 to function as the 
above-mentioned three-dimens ional real-time simulator 
30 . 

5 The embedded software developing program 313 renders 

the computer system 100 to function as the above-mentioned 
software developing section 40, and for this purpose, this 
program contains the status- transit ion diagram or table 
creating/editing program 320 that renders the computer 
10 system 100 to function as the above-mentioned 

status-transition diagram or table creating/editing 

section 4 1 . 

[0050] 

The first interface program 314 renders the computer 
15 system 100 to function as the above-mentioned first 

interface section 50. The first interface program 314 may 
be incorporated wholly in either one of the mechanism 
designing program 311 and the three-dimensional-mechanism 
model simulating program 312, or may be incorporated 
20 separately in these two programs 311, 312. 
[0051] 

The mechanism designing program 311 (mechanism 
designing section 20) is combined with the first interface 
program 314 (the first interface section 50), which is 
25 loaded in the computer system 100 where the first interface 
program 314 is executed in association with the operation 
of the three-dimensional-mechanism model simulating 



program 312, namely, the operation of the 
three-dimensional-mechanism model . 
[0052] 

The second interface program 315 renders the computer 
5 system 100 to function as the above-mentioned second 
interface sections 51, 52. 

Of the second interface program 315, one partial 
program corresponding to one second interface section 51 
may be incorporated wholly in either one of the 
10 three-dimensional-mechanism model simulating program 312 
and the status- transit ion diagram or table creating program 
32 0, or may be incorporated separately in these two programs 
312, 320. 
[0053] 

15 Of the second interface program 315, the other partial 

program corresponding to the other second interface section 
52 may be wholly in either one of the 

three-dimensional-mechanism model simulating program 312 
and the control program (embedded software), which is 
20 stored in the microcomputer chip 42, or may be separately 
incorporated in the three-dimensional-mechanism model . 
simulating program 312 and the control program. 
[0054] 

The integrated developing environment program 316 
25 renders the computer system 100 to function as the 
above-mentioned integrated developing environment 
section 4 3 . 
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In the present embodiment, as described above, the 
status- transition diagram or table creating program 320 
(the status-transition diagram or table creating/editing 
section 41) and the microcomputer chip 42 adopt a 
5 multi-task. 
[0055] 

Therefore, the second interface program 315 has a 
single synchronous task, whose priority is set to a highest, 
to represent a plurality of tasks to be executed by the 

10 status- transition diagram or table creating program 320 
or the microcomputer chip 42 . Using this synchronous task, 
the second interface program 315 renders the computer 
system 100 to stop the plural tasks in the status-transition 
diagram or table creating program 320 or the microcomputer 

15 chip 42 while the three-dimensional-mechanism model 

simulating program 312 (the three-dimensional real-time 
simulator 30) is operating, thereby synchronizing the 
operation according to the three-dimensional-mechanism 
model simulating program 312 with the respective operations 

20 according to the status- transit ion diagram or table 
creating program 320 and the microcomputer chip 42. 
[0056] 

At that time, the second interface program 315 (the 
second interface sections 51, 52) realizes the 
25 synchronization, which uses a synchronous task, between 
the three-dimensional-mechanism model simulating program 
312 and the status-transition diagram or table creating 



37 



program 320 or between the former program and microcomputer 
chip 42 (control program) by taking the following 
communications as the second interface program 315 is 
executed by the computer system 100. 
5 [0057] 

Namely, the three-dimensional-mechanism model 
simulating program 312 notifies the second interface 
program 315 of a time of execution (Ts) of the 
status- trans it ion diagram or table creating program 320 

10 or the control program. 

Upon receipt of this notice, the second interface 
program 315 (second interface sections 51, 52) allows the 
execution of the status- trans it ion diagram or table 
creating program 320 or of the control program by the 

15 notified time of execution. When the status- transition 
diagram or table creating program 32 0 or the control program 
has completed the allowed execution of the notified time 
of execution, then the second interface program 315 
interrupts such execution and notifies to the 

20 three-dimensional-mechanism model simulating program 312 
the obtained actuator instructing signal and the fact that 
the execution of the program for the allowed time has 
terminated . 
[0058] 

25 The three-dimensional-mechanism model simulating 

program 312 renders the three-dimensional-mechanism model 
to move by an extent corresponding to the control of 
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execution of the status-transition diagram or table 
creating program 320 or the control program for the allowed 
time of execution, obtaining a sensor signal corresponding 
to the extent of movement . After having obtained the sensor 
5 signal, the three-dimensional-mechanism model simulating 
program 312 determines the time of next execution of the 
status-transition diagram or table creating program 320 
or the control program, and notifies the second interface 
program 315 of the determined time of execution and the 
10 sensor signal. 
[0059] 

As this communication procedure is repeated, the 
three-dimensional-mechanism model simulating program 312 
and one of the status- transition diagram or table creating 

15 program 320 and the control program are executed. In the 
three-dimensional real-time simulator 30, a 
three-dimensional-mechanism model is operated in 
accordance with the control by the execution of the 
status- trans ition diagram or table creating program 320 

20 or the control program. 
[0060] 

Further, the three-dimensional-mechanism model 
architected in the computer system 100 (the 
three-dimensional real-time simulator 30) is operated in 
25 the computer system 100 by the three-dimensional-mechanism 
model simulating program 312, which constitutes the support 
program 310 loadedinthe computer system 100 from the CD-ROM 
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210 . 
[0061] 

And the status- transit ion diagram or table creating 
program 320 embedded in the computer system and the control 
5 program embedded in the microcomputer chip 42 (embedded 
software) are combined with the second interface program 
315 (second interface sections 51, 52) loaded in the 
computer system 100 and are executed in synchronism with 
the operation of the three-dimensional-mechanism model 
10 simulating program 312, namely, the operation of the 

three-dimensional-mechanism model in the computer system 

100 . 

[0062] 

As described above, the support system 10 of the 
15 present embodiment comprises the mechanism designing 

section 20, the three-dimensional real-time simulator 30, 
the status-transition diagram or table creating/editing 
section 41, the integrated developing environment section 
43, and the first and second interface section 50-52, all 
20 of which are embedded in a single apparatus (the computer 
system 100 here) . 

The support system of the present invention may be 
in an alternative form in which a plurality of computer 
systems 100 are communicably interconnected via the modem 
25 229 and a non-illustrated communications line and 

separately serve to function as the mechanism designing 
section 20, the three-dimensional real-time simulator 30, 
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the status- transit ional diagramor table creating/editing 
section 41, the integrated developing environment section 
43, and the first and second interface sections 50-52. 
[0063] 

5 In this alternative support system, the mechanism 

designing program 311, the three-dimensional-mechanism 
model simulating program 312, the status- trans it ion 
diagram or table program 320, the first interface program 
314, the second interface program 315, and the integrated 

10 developing environment program 316 are installed in the 
computer systems 100 which respectively function as the 
mechanism designing section 20, the three-dimensional 
real-time simulator 30, the status- trans it ion diagram or 
table creating section 41, the first and second interface 

15 sections 50-52, and the integrated developing environment 
section 43. 
[0064] 

In the support system 10 of the present embodiment, 
the microcomputer chip 42 in which the control program 

20 (embedded software) being developed is connected to the 
computer system 100 via a non-illustrated I/O 
( input /output ) board so that an actuator instructing signal 
(in an original sense, an electrical signal to be 
transmitted to a motor driver or the like) to be outputted 

25 from the microcomputer chip 42 based on the control program 
is input to the computer system via I/O board and also to 
the three-dimensional real-time simulator 30 via the second 
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interface section 52. And the three- 
dimensional real-time simulator 30 renders the three- 
dimensional-mechanism model in accordance with the 
actuator instructing signal to generate a sensor signal 
5 resembling a signal to be originally output from the sensor) , 
and then inputs the generated sensor signal to the 
microcomputer chip 42 via the second interface section 52 
and the I/O board. 
[0065] 

10 Thus in the support system 10 of the present embodiment, 

by taking the three-dimensional real-time simulator 30 as 
the pivot section, it is possible not only to progress the 
developing the embedded software (control program) 
separately (concurrently) of the designing the mechanism, 

15 without making a trial product of the mechanism, but also 
to efficiently develop the embedded software in the absence 
of a trial product of the mechanism, by combining the task 
control describing method, which is according to the 
status-transition diagram or table, with the 

20 three-dimensional real-time simulator 30. 
[0066] 

As described above, the support system 10 of the 
present embodiment is equipped with the mechanism designing 
section 20 for designing the mechanism during the mechanism 
25 simulation with real time, the three-dimensional real-time 
simulator 30 for simulating the mechanism with real time, 
and the embedded software developing section 40 for 



developing the embedded software with regarding a virtual 
three-dimensional-mechanism model on the 
three-dimensional real-time simulator 30 as an actual 
mechanism, all of which are operatively interconnected via 
5 the first and second interface sections 50-52. 
[0067] 

In the support system 10 of the present embodiment, 
the designing of the mechanism and the developing of the 
embedded software for controlling the mechanism are 

10 performed concurrently. The basic performing procedure 
will now be simply described. 

A designer of the mechanism progresses the designing 
of the individual parts and the designing of assembling 
these parts by making the mechanism designing section (an 

15 appearance design and CG system, and a three-dimensional 
CAD system) 20 the three-dimensional real-time simulator 
3 0 operative with each other via the first interface section 
50, while verifying the respective movements of various 
mechanisms, such as joints, gears and cam(s) in detail. 

20 During this designing, the mechanism designer inputs the 
designing data of the object parts, which are to be 
redesigned, for being dynamically reflected on the 
three-dimensional real-time simulator 30 via the first 
interface section 50 for every occurrence of design change, 

25 thereby verifying the movements of the whole assembly at 
that time. Since the three-dimensional-mechanism model 
to be dealt with the three-dimensional real-time simulator 
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30 is a software system, it is possible to reflect an 
arbitrary design change quickly as compared to the case 
that a trial product is actually manufactured. 
[0068] 

5 In the meantime, regarding the three-dimensional 

real-time simulator 30 as an actual apparatus, an embedded 
software developing person progresses the developing of 
the embedded software while making three-dimensional 
real-time simulator 30, the status-transition diagram or 

10 table creating/editing section 41 and the microcomputer 
chip 42 cooperative with one another via the second 
interface sections 51, 52. At that time, since the 
three-dimensional real-time simulator 30 quickly reflects 
an arbitrary design change having occurred in designing 

15 of the mechanism, the developing of the embedded software 
/will not be delayed due to the design change on the mechanism . 
[0069] 

The embedded software developing person firstly 
decides detail specifications of task control of the 

20 embedded software (task control flow) while making the 
status-transition diagram or table creating/editing 
section 41 and the three-dimensional real-time simulator 
30 with each other, and transfers the result of the decision 
to the integrated developing environment (microcomputer 

25 system developing environment) section 43. 

In the integrated developing environment section 43, 
the task control flow received from the status-transition 
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diagram or table creating/editing section 41 is converted 
into C, C++, and assembler coding to create an executing 
module (embedded software) , and the created embedded 
software is written into the microcomputer chip 42. 
5 [0070] 

Since the microcomputer chip 42 and the 
three-dimensional real-time simulator 30 can cooperate 
with each other via the second interface section 52, the 
embedded software developing section 40 can verify whether 

10 or not an executing module embedded in the microcomputer 
chip 42 performs a task control in accordance with the 
specifications, by moving a virtual mechanism model 
(three-dimensional-mechanism model) on the 
three-dimensional real-time simulator 30. 

15 [0071] 

Thus with the support system 10 of the present 
embodiment, by progressing the designing of the mechanism 
and the developing of the embedded software, with regarding 
the three-dimensional real-time simulator 30 as an 

20 intermediate, and interconnecting the microcomputer chip 
42 and the actual apparatus with each other to make a final 
combining test using the actual apparatus, it is possible 
to perform the designing of the mechanism and the developing 
of the embedded software with improved efficiency. 

25 [0072] 

The various parts of the support system 10 of the 
present embodiment will now be described in detail with 
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reference to FIGS. 5 through 82. 

To start with, the cooperating section (the first 
interface section 50) between the mechanism designing 
section (appearance design and three-dimensional CAD 
5 system) 20 and the three-dimensional real-time simulator 
30 will be described with reference to FIGS. 5 through 6B . 
[0073] 

FIG. 5 is a block diagram showing the main sections 
(the mechanism designing section 20 and the 

10 three-dimensional real-time simulator 30) of the support 
system 10, and FIGS. 6A and 6B are diagrams showing the 
respective examples of a figure data file and an assembly 
data file, which are to be transferred from the mechanism 
designing section 20 and the three-dimensional real-time 

15 simulator 30. 
[0074] 

As shown in FIG. 5, the figure data file (.sip file 
format) of various elements (parts) to be designed and the 
assembly data file (.asy file format), in which various 
20 elements are assembled, are read from the mechanism 
designing section (appearance design and 

three-dimensional CAD system) 20 to the three-dimensional 

real-time simulator 30. 

[0075] 

25 At that time, the above-mentioned first interface 

section 50 (FIG. 1) is interposed between the mechanism 
designing section 20 and the three-dimensional real-time 
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simulator 30. In the example of FIG. 5, the function of 
the first interface section 50 is wholly incorporated in 
either one of the mechanism designing section 20 and the 
three-dimensional real-time simulator 30, or is separately 
5 incorporated in the mechanism designing section 20 and the 
three-dimensional real-time simulator 30 . Therefore, the 
first interface section 50 is not shown in FIG. 5. 
[0076] 

As shown in FIG. 6 (A) , the figure data file is a file 
10 of format of .sip, which format describes an aggregation 
of triangular polygons, specifically writing the tangents 
of apices of the individual triangular polygons and the 
three-dimensional-position coordinates in sequence. And, 
as shown in FIG. 6(B), the assembly data file is a file 
15 format of .asy, in which format mutual arrangement 
information of the various elements are defined. 
[0077] 

After reading the files of .asy and .sip from the 
mechanism designing section 20, the three-dimensional 

20 real-time simulator 30 inputs mechanism information, such 
as joints, cam(s) and gears, and various items of 
characteristic information on a motor and a sensor via GUI 
(graphical user interface) of the three-dimensional 
real-time simulator 30 to complete a virtual mechanism 

25 model (three-dimensional-mechanism model). 
[0078] 

The relaying section (second interface section 51) 
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between the three-dimensional real-time simulator 30 and 
the status- transit ion diagram or table creating/editing 
section 41 will now be described with reference to FIGS. 
7 through 14 . 

5 FIG . 7 is a block diagram showing the main portion 

(the three-dimensional real-time simulator 30, the 
status-transition diagram or table creating/editing 
section 41, and second interface section 51) of the support 
system 10 of the first embodiment, FIGS . 8 and 9 respectively 

10 show two displayed examples of status- transit ion diagram 
and table, FIGS. 10(A) through 10(C) are a timing diagram 
illustrating a multi-task, FIGS. 11 (A) andll (B) illustrate 
how to schedule a task with priority , and FIGS. 12(A) through 
12 (D) are a timing diagram illustrating a synchronization 

15 process using a synchronous task. 
[0079] 

As shown in FIG. 7, the status-transition diagram 
or table creating/editing section 41 includes a task 
control section 411 for performing a task control described 

20 in a status transition, a user interface section 412 for 
editing the task control, which is to be performed by the 
task control section 411, using a keyboard, a mouse, etc . , 
a status-transition display section 413 for displaying the 
content of the task control to be performed by the task 

25 control section 411, and an interface section 414 for 
interacting with the three-dimensional real-time 
simulator 30. In the status- transit ion display section 
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413, the content of the task control to be performed by 
the task control section 411 (task control flow) is 
displayed in the form of a status- transit ion diagram 
graphically as shown in FIG- 8, or in the form of a table 
5 (status-transition table) as shown in FIG. 9. 
[0080] 

And the three-dimensional real-time simulator 30 
includes a simulating section 31 for performing a three- 
dimensional-mechanismmodel simulation with real time, and 
10 an interface section 32 for interacting with the 

status-transition diagram or table creating/editing 
section 4 1 . 

The interface sections 414, 32 constitute the above- 
mentioned second interface section 51. Namely, in the 

15 example of FIG. 7, the function as the second interface 
section 51 is separately incorporated in the 
three-dimensional real-time simulator 30 and the 
status- transition diagram or table creating/editing 
section 4 1 . 

20 [0081] 

In the three-dimensional real-time simulator 30 
operatively connected with firmware (the 
status-transition diagram or table creating/editing 
section 41 and the microcomputer chip 42) , it is essential 
25 to simulate the three-dimensional-mechanism model 

(virtual mechanism model ) as such in movement with the same 
time scale as real time on the firmware. 



Assuming that calculation of time Ts is performed 
by tasks 1, 2 of the firmware as shown in FIGS. 10(A) and 
10(B), simulation of the virtual mechanism 

(three-dimensional-mechanism model) for the time Ts is 
continued on the three-dimensional real-time simulator 30 
as shown in FIG. 10(C). 

[0082] 

However, as shown in FIGS. 10(A) and 10(B), when a 
plurality of ( two in these two views ) tasks run in parallel, 
stopping/starting the processes of the plural tasks 
concurrently in synchronism with one another would 
encounter problems as to which task should be in charge 
of management of time and how to interrupt / restart the 
processes, for example. 

Consequently, in the present embodiment, a 
synchronous task (synchronous take) as such shown in FIG. 
12 (C) .is provided to perform management of time and 
controlling of the starting/stopping of the other tasks 
so that the firmware and the three-dimensional real-time 
simulator 30 is synchronized with each other without adding 
any special process to the tasks. 
[0083] 

At that time, a function of scheduling tasks by 
priority is used as the basic function of real-time OS. 
In complicated embedded software (firmware), various 
processes are performed by aplurality of tasks on real-time 
OS. Though plural tasks can run in parallel on real-time 
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OS, there is only a single resource (CPU); consequently 
OS schedules which task CPU should be allocated to. 
[0084] 

For this scheduling, it has been a common practice 
5 to set the tasks by priority and then allocate CPU to a 
higher-priority upon receipt of simultaneous requests for 
use of CPU from plural tasks . As such shown in FIGS . 11 (A) 
and 11 (B) , when a higher-priority task H starts the process 
during the process of a low-priority task L, OS interrupts 
10 the process of the task L and transfers the right to execute 
the process to the task H. Upon termination of the process 
of the task H, OS restarts the process of the task L being 
interrupted. 
[0085] 

15 By setting the priority of a synchronous task to higher 

than the other tasks using the function of changing over 
the task by priority, the synchronous task can control 
starting/stopping the other tasks . At that time, ordinary 
tasks require no special process for synchronization. 

20 As such shown in FIGS. 12(A) through 12(D), during 

execution of simulation for the time Ts on the 
three-dimensional real-time simulator 30 in 
correspondence with calculation of the time Ts by two tasks 
1, 2, which are to be executed in parallel , with the prior ity 

25 of a newly added synchronous task set to the highest, the 
right to execute the process by CPU is transferred to the 
synchronous task. As a result, during that time, the 



processes of the tasks 1, 2 are interrupted and will not 
be restarted until after termination of simulation for the 
time Ts. 
[0086] 

5 FIG. 13 is a block diagram illustrating a 

synchronization process using a synchronous task of the 
first embodiment. In the example of FIG. 13, the second 
interface section 51 (52) between the status- transition 
diagram or table creating/editing section 41 
10 (microcomputer chip 42) and the three-dimensional 

real-time simulator 30 is realized by a shared memory 53. 
[0087] 

The status- transition diagram or table 
creating/editing section 41 executes n (natural number) 

15 tasks 1 through n are executed in parallel, referring to 
individual data in an internal memory 415. During the 
process of the synchronous task, the status- transit ion 
diagramor table creating/editing section 41 reads out data 
(actuator instructing signal) in the internal memory 415 

20 to send the read-out data to the three-dimensional 

real-time simulator 30, and receives data (sensor signal) 
from the three-dimensional real-time simulator 30 to write 
the received data to the internal memory 415. 
[0088] 

25 At that time, the individual data may be sent to and 

received from the three-dimensional real-time simulator 
30 (virtual mechanism) in timed relation to the processes 
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of the individual tasks. In the present embodiment, 
however, in order for efficient communications, the 
synchronous task serves to previously buffer data in the 
internal memory 415 and then performs 
5 transmitting/receiving of the data collectively at 

intervals, one individual collected quality of data at a 
needed time. The communications method may be the 
above-mentioned method using a shared memory 53, a socket 
communications method, or a message communications method . 
10 [0089] 

The process of synchronization using a synchronous 
task will now be described using the flow diagram (steps 
Sll through S19) of FIG. 14. 

As shown in FIG. 14, the next calculated time 

15 (processing time) Ts, along with the result of the previous 
simulation (sensor signal), is transmitted from the 
three-dimensional real-time simulator 30 to the 
status-transition diagram or table creating/editing 
section 41 (microcomputer chip 42) where the time Ts is 

20 set (step Sll) . 
[0090] 

Then the processing of the synchronous task is stopped 
for only the time Ts (step S12) . Namely, the processing 
of the plural tasks is executed for the time Ts, and actuator 
25 instructing signals (motor instructing signal) obtained 
one for the process of each task are written in the internal 
memory 415. In the present embodiment, the synchronous 
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task is normally kept stopping, and will becomes operative 
after the lapse of time Ts. This can be realized by the 
timer function and the sleep function, which are those of 
OS . 
5 [0091] 

After the processing of the synchronous task has been 
stopped to stand by for only the time Ts (step S12), the 
synchronous task is rendered operative to interrupt all 
the other tasks. By the synchronous task, the output data 

10 (instructing signal) from the individual tasks are read 
out from the internal memory 415 (step S13) and written 
to the shared memory 53 (step S14) , whereupon "0" is written 
to the shared memory 53 as a synchronous flag 1 (Loop Flag) 
(step S15) , thereby permitting the three-dimensional 

15 real-time simulator 30 to execute the processing. In 
response to this, in the shared memory 53, a synchronous 
flag 2 (Ready Flag) is set from "0" to 
[0092] 

After that, the status-transition diagram or table 
20 creating/editing section 41 (microcomputer chip 42) waits 
for a termination-of -simulation notice from the 
three-dimensional real-time simulator 30, keeping the 
other tasks being interrupted. 

Upon receipt of a start-execution-of-simulation 
25 instruction from the status-transition diagram or table 
creating/editing section 41 (microcomputer chip 42), the 
three-dimensional real-time simulator 30 performs 



simulation for the time Ts. Then upon completion of 
simulation for the time Ts, the three-dimensional real-time 
simulator 30 writes the result of the simulation (sensor 
signal) and the next calculated time (processing time) Ts 
5 in the shared memory 53 to overwrite the synchronous flag 
2 (Ready Flag) on the sharedmemory 53 into "0", then standing 
by until it receives the next 

start-execution-of-simulation instruction from the 
status-transition diagram or table creating/editing 
10 section 41 (microcomputer chip 42). 
[0093] 

When it recognizes that the synchronous flag 2 (Ready 
Flag) on the shared memory 52 has become "0", namely, the 
simulation has been completed (YES route of step S16) , the 

15 status-transition diagram or table creating/editing 
section 41 (microcomputer chip 42) overwrites the 
synchronous flag 1 (Loop Flag) on the shared memory 53 into 
"0" [sic] (step S17) and reads out input data, which is 
the result of the simulation (sensor signal), from the 

20 shared memory 53 (step S18) and writes the read-out input 
data to the internal memory 415 (step S19) . At that time, 
the next calculated time (processing time) Ts also is 
written into the internal memory 415, whereupon the 
procedure returns to step Sll to repeat execution of the 

25 same process as described above. 
[0094] 

By repeating the foregoing process ing, it is possible 
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to establish precise synchronization between the 
status-transition diagram or table creating/editing 
section 41 (microcomputer chip 42) and the 
three-dimensional real-time simulator 30 even if a 
5 multi-task is employed in the status-transition diagram 
or table creating/editing section 41 (microcomputer chip 
42) . 

At that time, the time Ts should by no means be fixed 
and may vary depending on the status of the simulation; 
10 for this purpose, as described above, the simulation time 
Ts is transferred upon synchronization. 
[0095] 

Further, in the status-transition diagram or table 
creating/editing section 41 (microcomputer chip 42) , data 

15 (such as an instructing signal) to the three-dimensional 
real-time simulator 30 is transmitted to the 
three-dimensional real-time simulator 30 before starting 
the simulation. After termination of the simulation, the 
data (such as a sensor signal) from the three-dimensional 

20 real-time simulator 30 is received before starting the 
calculating of the status-transition diagram or table 
creating/editing section 41 (microcomputer chip 42) and 
written into the internal memory 415. 
[0096] 

25 The second interface section 52 between the 

three-dimensional real-time simulator 30 and the 
microcomputer chip 42, which is similar in construction 
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to the second interface section 51 described in connection 
with FIGS. 5 through 14, serves to function likewise the 
second interface section 51 so that the microcomputer chip 
42 and the three-dimensional real-time simulator 30 are 
5 exactly synchronized with each other even if a multi-task 
is employed in the microcomputer chip 42. 
[0097] 

Practically the status-transition diagram or table 
creating/editing section 41 is exemplified by technologies 

10 disclosed as such in StateFlow (product of MathWorks Inc. ) 
manual, StateMate (product of iLogix Inc. ) manual and ZIPC 
(product of CATS) manual. And the integrated developing 
environment section 43 is exemplified by technologies 
disclosed as such in Softune (product of Fujitsu Inc.) 

15 manual. The status- transition diagram or table 

creating/editing section 41 and the integrated developing 
environment section 43 are operatively interconnected so 
that the task control flow created by the status-trans ition 
diagram or table creating/ edi t ing section 41 is loaded into 

20 the integrated developing environment section 43 where 
finally a target- 
microcomputer execution module is created seamlessly. 
[0098] 

As mentioned above, after designing of the mechanism 
25 and developing of the embedded software have been 

concurrently progressed utilizing the three-dimensional 
real-time simulator 30, combination of the mechanism and 



the embedded software is tested (the actual system is 
finally confirmed) using a trial product of an actual 
interface (by interconnecting the actual system and the 
microcomputer chip 42) . 
5 Further, as mentioned above, the three-dimensional 

real-time simulator 30 is equipped with a logic analyzer 
(analyzing section) . This logic analyzer, as shown in FIG. 
15, analyzes a change with time between a actuator 
instructing signal for the actuator (motor) and a sensor 

10 signal obtained by the three-dimensional real-time 

simulator 30 with real time under a synchronous algorithm, 
displaying this change as the result of simulation so that 
an embedded software developing person can confirm the 
change with time. The logic analyzer serves also to 

15 preserve data and print the data. 
[0099] 

FIG- 16 is a flow diagram illustrating the procedure 
of a whole simulating process including a process by the 
logic analyzer of the first embodiment. As shown in FIG. 

20 16, during the simulation by the three-dimensional 

real-time simulator 30, the motor processing is performed 
based on the actuator instructing signal from the 
status-transition diagram or table creating/editing 
section 41 and the microcomputer chip 42 (step S22) while 

25 establishing synchronization by the second interface 

sections 51, 52 ( step S2 1 ), whereupon the sensor processing 
is performed in accordance with the actuator instructing 
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signal (step S23). During the processing of steps S21 
through S23, inputting/outputt ing is performed by the I/O 
board or socket communication so that the output values 
with these processes are buffered and can be read out later. 
5 On the other hand, since it is guaranteed that the input 
values do not vary at steps other than the synchronization 

(step S21), no buffering is performed. 

[0100] 

I f the proce ssing by the logic analyzer is unnecessary 
10 (NO route of step S24) , the procedure returns to step S21. 
Otherwise if the processing by the logic analyzer is 
necessary (YES route of step 24) , the actuator instructing 
signal and the sensor signal are stored and displayed (step 
S25) . 

15 At that time, in the present embodiment, since the 

time Ts for simulation occasionally varies for every loop, 
the information in the logic analyzer is stored using three 
rows of arrangement of "time", "PIO value" and "DA value" . 
[0101] 

20 For saving the memory capacity, as the arrangement 

of "time", the number of control loops (n is the frequency 
corresponding to time Ts and described later in connection 
with FIG. 33) designatedby the three-dimensional real-time 
simulator 30 during the synchronization is stored. As the 

25 arrangement of "PIO value", data of 32 channels is stored 
for every bit. As the arrangement of "DA value", data of 
2 channels is quantized into 16 bits and is stored as a 



32-bit integer. 
[0102] 

The three-dimensional real-time simulator 30 of the 
support system 10 of the present embodiment will now be 
5 described in further detail with reference to FIGS. 17 
through 82. 

FIG. 17 is a concept diagram illustrating the mode 
of operation of a three-dimensional model simulator of the 
support system of the first embodiment. As shown in FIG. 
10 17, a three-dimensional-mechanism model (hereinafter also 
called "3D model") is architected in the three-dimensional 
real-time simulator (hereinafter also called "3D model 
simulator" ) . 
[0103] 

15 3D model is a three-dimensional model of a product 

which model is defined by three-dimensional mechanism data 
defining the relations between three-dimensional shapes 
of plural links (individual parts constituting a product) 
and postures of the individual parts; the 3D model of a 

20 link is moved as the posture of the link is changed. 

An actuator instructing signal for moving an actuator, 
such as a motor, is transmitted from the embedded software 
developing section 40 (the status-transition diagram or 
table creating/editing section 41 and the microcomputer 

25 chip 42) to the 3D model simulator 30, and a sensor signal 
indicating the on/off state of a sensor is transmitted from 
the 3D model simulator to the embedded software developing 



section 40. In FIG. 17, the second interface sections 51, 
52 (FIG. 5) serving to receive/ transmit synchronous signals 
are not shown. 
[0104] 

5 FIG. 18 is a diagram of the 3D model simulator 30, 

illustrating how to define a sensor and a motor, and FIG. 
1 9 is a diagram illustrating a simulating process according 
to the 3D model simulator 30 of the first embodiment. 

3D model is architected by the mechanism designing 
10 section 20, such as three-dimensional CAD; as shown in FIG. 
18, a motor and a sensor are defined on the architected 
3D model as the input device such as a keyboard is operated 
by the user. 
[0105] 

15 For practical simulation after this defining, as 

shown in FIG. 19, the posture of a line defined as the motor 
(hereinafter also called "motor link") is varied in 
accordance with an actuator instructing signal received 
from the embedded software developing section 40. Based 

20 on the mechanism data, other links connected with the motor 
link are moved by an extent corresponding to the change 
in posture of the motor link, giving influence also on the 
posture of a link defined as the sensor (hereinafter also 
called "sensor link") . Then a sensor signal corresponding 

25 to the posture of the sensor link is generated and 

transmitted to the embedded software developing section 
40 . 
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[0106] 

FIG.20isa timing diagram illustrating the operating 
timing between the 3D model simulator 30 and the embedded 
software developing section 40 (synchronous task) 
5 according to the first embodiment. The hatched portions 
in FIG. 20 each indicate a period for which the 3D model 
simulator 30 or the embedded software developing section 
40. 

As shown in FIG. 20, the 3D model simulator 30 and 
10 the embedded software developing section 40 (the off-state 
operation of a synchronous task) repeat alternately the 
operating and stopping cycles . In each cycle, the 3Dmodel 
simulator 30 and the embedded software developing section 
40 operate in the following procedure. The detail of 
15 synchronization between the 3D model simulator 30 and the 
embedded software developing section 40 (synchronous task) 
will be described later. 
[0107] 

(1) The 3D model simulator 30 performs simulation 
20 for the simulation time Ts, based on the actuator 

instructing signal, and outputs a sensor signal. 

(2) the 3D model simulator 30 determines the 
simulation time Ts for the next loop from the possibility 
of interference of a current 3D model, transfers the 

25 determined simulation time Ts and an operation start 
instruction (Ready Flag) to the embedded software 
developing section 4 0 . 
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[0108] 

(3) The embedded software developing section 40 
receives the time Ts and the operation start instruction 
(Ready Flag) and then, as described above in connection 

5 with FIGS. 12 through 14, performs calculation (control) 
for the time Ts by a multi-task, with the synchronous task 
being off, whereupon the embedded software developing 
section 40 sends an operation termination signal (Loop 
Flag) to the 3Dmodel simulator 30 to interrupt the operation 
10 of the 3D model simulator 30, with the synchronous task 
being on, until receiving the next operation start 
instruction (Ready Flag) . 
[0109] 

(4) The 3D model simulator 30 starts simulation for 
15 the time Ts upon receipt of the operation termination signal 

(Loop Flag) of the embedded software developing section 
40 . 

The 3D model simulator 30 and the embedded software 
developing section 40 operate alternately synchronously 
20 with each other by repeating the foregoing procedure. 

FIG. 21 is a flow diagram illustrating the simulation 
procedure according to the 3D model simulator 30 of the 
first embodiment. 
[0110] 

25 As shown in FIG. 21, the simulation starts with 

initialization (step S101) to initialize the posture of 
the individual links of the 3D models. Then a distance 



(simulation distance) Ts to perform the simulation is sent 
to the embedded software developing section 40 (step S102) . 
Upon receipt of a signal indicating that the simulation 
distance Ts has been received from the embedded software 
5 developing section 40 (YES route of step S103), a 

calculation start instruction is sent to the embedded 
software developing section 40 (step S104). 

[0111] 

When the embedded software developing section 40 has 
10 performed calculation for the simulation distance Ts and 
the termination of the calculation is notified (YES route 
of step S105), all the motors and all the sensors, which 
constitute the 3D model being simulated are initialized 
as being unprocessed for the current Ts (step S106) . 
15 [0112] 

Then at step S201, it is discriminates whether or 
not there exist unprocessed motors, and the processes of 
steps S202 through S207 are performed for each and every 
unprocessed motor . 

20 Namely, if unprocessed motors exist (YES route of 

step S201) , a rate of rotation of a motor currently being 
processed is determined in accordance with an actuator 
instructing signal received from the embedded software 
developing section 40 relating to the current motor (step 

25 S202), and the motor posture varying in the distance Ts 
is determined from the rotating rate (step S203). 
[0113] 
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Then the postures of other parts related with the 
current motor according to the above-mentioned mechanism 
relation definition are changed (step S204), and the 
shortest distance d between the individual parts is 
5 measured (step S205) . At steps S206, S207, the shortest 
distance D, among all the individual shortest distances 
d measured in terms of rotations of the individual motors . 

It is discriminated whether or not a newly measured 
shortest distance d is smaller than the past shortest 

10 distance D (step S206) . If it is smaller (YES route), the 
newly measured shortest distance d is replaced with the 
past shortest distance D (step S207), whereupon the 
procedure returns to step S210. Otherwise if it is not 
smaller (NO route) , the procedure only returns to step S201 . 

15 [0114] 

The foregoing processes of steps S 202 through S207 
are repeatedly executed until it takes NO route at step 
S201, namely, until it is judged that no unprocessed motor 
exists . 

20 Thus when changing of the posture in the time Ts for 

each and every motor has been completed, the resultant 3D 
model is displayed on the screen (step S208). 
[0115] 

After that, it is discriminated whether or not there 
25 exist unprocessed sensors (step S301). If unprocessed 
sensors exist (YES route), the on/of f state of each of sensor 
signals in accordance with the postures of the 
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corresponding sensor links is detected for each and every 
unprocessed sensor (step S302). 

When the processes of all the sensors have been 
completed (NO route of step S301) , a sensor signal related 
5 to all these sensors is outputted to the embedded software 
developing section 40 (step S303) , and a sampling distance 
Ts corresponding to the shortest inter-part distance D is 
determined (step S401), whereupon the procedure returns 
to step S102 to send the determined distance Ts to the 
10 embedded software developing section 40, 
[0116] 

In the 3D model simulator 30, as the foregoing 
processes are repeatedly executed, simulation of movement 
of the 3D model performed while the 3D model simulator 30 

15 is kept in synchronization with the embedded software 
developing section 40. 

FIG. 22 is a flow diagram illustrating a partial flow 
(a portion surrounded by a dot-and-dash line in FIG. 21) 
to be substituted for a partial flow of simulation procedure 

20 of the simulator of FIG. 21. 
[0117] 

In FIG. 22, step S210 is inserted between step S202 
and step S203. At this step s210, it is discriminated 
whether or not the rate of rotation of the motor being 
25 currently processed is zero ( co=0) . If co=0 (YES route) , 
the procedure goes to step S211 to assume the distance d= 
00 without measuring the inter-part distance d for the 



movement of the motor, whereupon the procedure shifts to 

step S206. As a result, the distance d=°° is excluded from 
the arithmetic operation for obtaining the distance D. 

Otherwise if d^O (NO route) , the procedure shifts to step 
5 S203 where the above-mentioned process is performed. 
[0118] 

Although a considerable amount of calculation is 
required to obtain the inter-part distance d, it is possible 
to reduce the amount of calculation by the 3D model simulator 
10 30 to speed up the simulation, without measuring the 
distance d related to the motor if the motor takes no 
rotation . 

FIG. 23 is a perspective diagram showing one example 
of motor link to illustrate how to select a link tobe defined 
15 as a motor (motor link) . 
[0119] 

In FIG. 23, the original motor is shown as a link 
A, and the linkAitself is fixedto the base . Consequently, 
on simulation, a link B whose posture is varied in the 3D 
20 model when driven earliest by the original motor is treated 
(defined) as a motor link. By defining the motor link in 
this way, it is possible to facilitate simulation. 
[0120] 

FIGS. 24(A) and 24(B) are perspective diagrams 
25 showing one example of a sensor link to illustrate how to 
select a link to be defined as a sensor (sensor link) , and 
FIGS. 25(A) and 25(B) are perspective diagrams showing 
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another example of a sensor link to illustrate how to select 
a link to be defined as a sensor (sensor link) . 

In FIGS. 24(A), 24(B), 25(A) and 25(B), though the 
original sensor is a link A, a link B to be detected by 
5 the original sensor is defined as a sensor link. In 

accordance with the posture (position) of the link B, the 
status of FIGS . 24 (A) and 25 (A) is defined as the off state 
of the sensor, while the status of FIGS. 24(B) and 25(B) 
is defined as the on state of the sensor. Thus, in the 

10 case of the sensor, likewise in the case of the motor, partly 
since the link to be detected by the original sensor is 
defined as the sensor (sensor link), and partly since the 
on/off states are defined in accordance with the posture 
of the sensor link, it is possible to facilitate simulation . 

15 [0121] 

FIG. 26 is a diagram illustrating various kinds of 
motors . 

As shown in FIG. 26, in the present embodiment, two 
methods, i.e. "stepless speed change" and "stepwise speed 

20 change", are prepared to define a motor. 

"Stepless speed change" is a method of defining a 
proportional constant between a speed instruction value 
and a target speed. For the stepless speed change method, 
two more methods, i.e. a method of taking "proportion 

25 irrespective of positive/negative" and a method of 

regarding the "highest-position bit of a binary number as 
a sign", are prepared. In the former method, if a 



proportional constant is 100, a binary number 101 (-3 in 
decimal notation) is converted into -300 rpm (minus signal 
indicates rotation in reverse direction) . And in the 
latter method, if a binary number 101, for example, is 
5 divided into two parts, i.e. the highest-position bit y l' 
and the remaining bits x 01' . And the highest-position bit 
x l' is assumed as a minus sign ( x 0' is a plus sign) while 
the remaining string of bits x 01' is assumed a numerical 
value (1 in decimal notation) , and -1, which is the result 
10 of combination of the minus sign and the numerical value, 
is multiplied by a proportional constant 100 to obtain a 
converted value -100 (rpm) . 
[0122] 

For "stepwise speed change", a correlation table of 
15 speed instruction values and target speeds is defined. As 
such in the correlation table of FIG . 26, -2 00 rpm is defined 
for 101 in binary notation; if 101 in binary notation is 
input as a speed instruction value, -200 rpm is output as 
a target speed with referring to the correlation table. 
20 The correlation table may be an alternative form described 
later in connection with FIG. 75. 
[0123] 

According to the present embodiment, since the 
above-mentioned various kinds of defining methods are 
25 prepared, it is possible to improve the degree of freedom 
in defining a motor. 

FIG. 27 is a graph showing an initial change of 



rotation rate co of a motor when the motor is regarded as 
a primary delay system. 

As the change in rotation rate of a motor is treated 
as a primary delay system of FIG . 27, simulation is performed 
5 with taking consideration of a delay due to the load of 
the motor and influence of the delay. If the motor is 
treated as a primary delay system, the user can designate 
a characteristic of the motor by only inputting a settling 
time 4T, thereby minimizing the labor for inputting. 
10 [0124] 

Assuming that the motor is treated as a primary delay 
system, an extent of rotation A 0 of the motor in the 
simulation distance Ts is calculated by the following 
equation (1) . The simulation distance Ts is represented 
15 by A t . 

The motor speed co at time t is expressed by the 
following equation (1) . 
[0125] 

[Equation 1] 



[0126] 

where co ^ is the target speed, co 0 is the motor speed before 
instructing the target speed, and T is a constant 
proportional to the settling time 4T indicating a 
25 characteristic of the motor. 



20 




(1) 



Assuming that the motor speed co at the time t as 



expressed by the above equation (1) is co^-i, a motor speed 
co k at the time t + At, i.e. at a time later than the time 
t by At will be as expressed by the follow equation (2) . 
[0127] 
5 [Equation 2] 



[0128] 

These equations (1) and (2) yield the following 
equation ( 3 ) . 
10 [0129] 

[Eqaution 3] 



[0130] 

The amount A 6 the motor rotates for A t is expressed 
15 by the following equation (4) as the above equation (3) 

is integrated with respect to At. 
[0131] 

[Equation 4] 



A0 = r G>^ + (£D -a) k .h-e 



T 

) 



dt 



20 [0132] 

Assuming the motor is treatedas a primary delay system, 
the rotation amount A 6 of the motor for a period of 
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simulation time At can be obtained by the target speed 
co i, the simulation time At, the motor speed co^^, and the 
settling time 4T according to the above equation (4). 

The motor should by no means to operate normally as 
5 expressed by the equation (4) , and as an alternative, the 
speed may be fixed to co ^ with lapse of a settling time 
4T after the target speed co j_ to be instructed to the motor 
has varied. 
[0133] 

10 FIG. 28 is a flow diagram illustrating a motor driving 

process, with a primary delay considered, in the 3D model 
simulator 30 of the first embodiment. 

As shown in FIG. 28, when the simulation distance 
At (=Ts) is determined based on the inter-part distance 

15 (step S501) and the actuator instructing signal is input 
from the embedded software developing section 40 (step 
S502), the target speed co ± is determined with reference 
to the correlation table or the proportional constant 
according to the definition of the motor of FIG. 26 (step 

20 S503) . 
[0134] 

At step S504, it is discriminated whether or not the 
target speed co j_ has varied (whether or not co ± = coiold) • 
If the current target speed co ^ has varied (NO route; co 
25 i ^ ^iold) ' the procedure goes to step S505 so that t^- 0 tal 
indicating a lapse of time from the time point when the 
target speed co ± has varied is initialized to zero. Then, 
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for the next judgment at step S504, co j_ is stored to update 
°> iold (step S506), and then the procedure shifts to step 

5507 . 
[0135] 

5 If co i = co iold as the result of discrimination (YES 

route), the procedure skips over steps S505 and S506 and 
goes directly to step 507 to discriminate whether or not 
the lapse of time t^otal from the time point when the target 
speed co ^ has varied reaches the settling time 4T . If t total 
10 does not reach 4T (NO route) , the procedure goes to step 

5508 to obtain the rotation speed co of the motor in 
accordance with the equation (3) , and then forward to step 

5509 to obtain the rotation amount A 0 of the motor in 
accordance with the equation (4) . 

15 [0136] 

Otherwise if t^otal — 4T as the result of 
discrimination (YES route), the procedure goes to step S51 0 
to set the rotation speed co of the motor to a value equal 
to the target speedco-L, and then forward to step 511 to 
20 set the rotation amount A 6 of the motor for a period of 
simulation time At can be obtained by the target speed 
co i . 

Even if the procedure skips over steps S508, S509 
or steps S510, S511, t^otal increases by At subsequently 
25 at step S512 and then the total rotation amount 0 increases 
by A 0 at step S513 . 
[0137] 
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As the processes of FIG. 28 are repeatedly executed 
taking synchronization with the embedded software 
developing section 40, the motor rotates in a varying speed 
as treated as the primary delay system of FIG. 27. 
5 FIGS. 29, 30 and 31(A) through 31(C) are diagrams 

illustrating how to define a sensor using an interference 
check . 
[0138] 

FIG. 29 shows an example in which the posture of a 
1 0 contact sensorSl is determined by a combination of postures 
of plural motors M. In this illustrative example, if 
adopted the method described above in connection with FIGS . 
24 (A) , 24 (B) , 25 (A) and 25 (B) , the on/off status of a sensor 
SI would be defined by the combination of the respective 
15 postures of plural motors M, which would require a much 
more complicated definition . Consequently, in the example 
of FIG. 29, an interference check is made between the sensor 
SI and the base; the sensor SI assumes the on status or 
the off status, depending on presence/absence of 
20 interference between the sensor SI and thebase. With this 
arrangement, it is possible to determine the on/off status 
of the sensor SI without requesting the user for any 
complicated definition . 
[0139] 

2 5 FIG . 30 shows another example in which a photoelectric 

sensor (phototube) S2 repeatedly assumes the on and off 
status as a slit SL is moved. In this illustrative example, 
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treating an optical bundle of FIGS. 31(A) through 31(C) 
as a single virtual link, the on/off status of the sensor 
S2 is discriminated, depending on presence/ absence of 
interference between the virtual link and the slit SL. 
5 In checking interference between the virtual link 

and a companion link, such companion link may be limited 
if is in advance known as shown in FIG. 30. Otherwise if 
it is unknown, a companion linktobe checked in interference 
is excluded since a link representing the original sensor 
10 itself is normally in interference (engagement) with the 
virtual link. 
[0140] 

The sensor output determining method using the 
virtual link should by no means be limited to the 
15 photoelectric sensor, and may be alternatively applied to 
a contact- type position detecting sensor in which a contact 
of a micro switch, for example, is defined as a virtual 
link . 

The sensor defining method described above in 
20 connection with FIGS. 24(A), 24(B), 25(A) and 25(B) is 
particularly effective in expressing a sensor which detects 
a change in single-degree freedom. Such sensor is a sensor 
which detects an angle of a potentiometer, encoder or the 
like . However, i f adopted the definition method in a sensor 
25 in which the posture is determined as the result of 
combination of a multi-degree freedom, e.g. the 
above-mentioned sensor (FIG. 29), which is located so as 
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to determine the output by the combination of the postures 
of plural motors, or another sensor which frequently 
assumes on/off statuses, e.g. the above-mentioned slit 
counter (FIG. 30), it would request the user for a 
5 complicated definition. Consequently it is preferable to 
adopt the illustrated method which can discriminate the 
on/off status of the sensor in terms of presence/absence 
of interference between the companion links. 
[0141] 

10 FIG. 32 is a timing diagram illustrating various 

signals to be transferred between the 3D model simulator 
30 and the embedded software developing section 40 to 
establish synchronization in the first embodiment, FIG. 
33 is a flow diagram illustrating how to establish 

15 synchronization in operation between the 3D model simulator 
30 and the embedded software developing section 40, and 
FIG. 34 is a flow diagram illustrating the processing of 
the 3D model simulator 30 to realize synchronization in 
operation between the 3D model simulator 3 0 and the embedded 

20 software developing section 40. A program for realizing 
the synchronization method described later in connection 
with FIG . 3 3 is incorporated in the second interface program 
315 for realizing the second interface sections 51, 52. 
[0142] 

25 A Loop Flag, a Ready Flag and a Time Scale, all of 

which are shown in FIG. 32, are signals respectively having 
the following meanings: 
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(1) Loop Flag: 

A signal to be transferred from the embedded software 
developing section 40 and the 3D model simulator 30, 
indicating whether or not the embedded software developing 
5 section 40 is currently in operation. 
[0143] 

(2) Ready Flag: 

A signal to be transferred from the 3D model simulator 
30 to the embedded software developing section 40, 
1 0 indicating that simulation for a single simulation distance 

At (=Ts) on the 3D model simulator 30 has completed. 

(3) Time Scale: 

A signal to be transferred from the 3D model simulator 
30 to the embedded software developing section 40, 

15 representing the simulation distance At (=Ts) which is 
determined based on the shortest inter-part distance by 
the 3D model simulator 30. 
[0144] 

In the present embodiment, as a Time Scale to designate 
20 a simulation distance At (=Ts), a frequency n (natural 
number) of passing the process routine of FIG. 33 in the 
period of the simulation distance At (=Ts) isused, without 
using a specific time, such as 5 msec or 2 sec. 

As shown in FIG. 32, it is discriminated whether or 
25 not n=0 at step S60. If not n=0 (NO route) , the procedure 
goes to step S602 to decrease n by 1, shifting to execution 
of the original process (the transition diagram or table 



creating program 320 and the control program) . Only when 
n=0 as the result of discrimination at step S61 (YES route) , 
Loop Flag is set to 'Low' to start a synchronous task (step 
S603), whereupon the processes of steps S604 through S607 
5 are executed. 
[0145] 

For explaining FIGS. 32 through 34, assume that 
simulation is currently performed on the 3D model s imulator 
30; on the embedded software developing section 40, 

10 therefore, with Ready Flag in 'Low' level, the procedure 
stays at step S604 of FIG . 33 to stand by until Ready Flag 
is changed to x High' . At that time, in the routine of FIG. 
34 indicating the synchronization in the 3D model s imulator 
30, it is in the middle of simulation of step S703. 

15 [0146] 

On the 3D model simulator 30, after initialization 
is performed (step S701) , the procedure goes to step S702 
to stand by until Loop Flag is changed to x Low' . When Loop 
Flag is changed to x Low' by the process of step S603 described 
20 above in connection with FIG. 32, the procedure goes to 
step S703 where simulation for the simulation distance A 
t takes place. 
[0147] 

Upon completion of the simulation, the 3D model 
25 simulator 30 shifts the procedure to step S704 of FIG. 34 

where the next simulation distance (Time Scale) At is 
determined by the above-mentioned frequency n . And at step 
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S705, this Time Scale A t (n) is transmitted to the embedded 
software developing section 40. The procedure goes 
further to step S706 where Ready Flag is changed to 'High' 
level . 
5 [0148] 

In response to this, on the embedded software 
developing section 40, the procedure escapes from step S604 
of FIG. 33 (YES route) and goes to step S605 where Time 
Scale n is read in. The procedure goes further to step 

10 S606 where Loop flag is changed to 'High' to stop the 
synchronous task. Subsequently at step S607, the 
procedure goes forward to the original process after Ready 
flag being sent from the 3D model simulator 30 is changed 
to 'Low' . 

15 [0149] 

In the embedded software developing section 40, the 
transition diagram or table creating program 320 and the 
control program are repeatedly executed at a constant cycle . 
As mentioned above, at step S601, it is discriminated 

20 whether or not n=0; if n^0 (NO route) , the procedure goes 
to step S602 where n is decreased by 1 . If n=0 as the result 
of discrimination at step s601 (YES route) as this routine 
is repeated, the procedure goes to step S603 where Loop 
Flag is changed to 'Low' to start the synchronous task. 

25 Subsequently at step S604, the procedure stands by until 
Ready Flag being transmitted from the 3D model simulator 
30 is changed to 'High' . 



[0150] 

In the meantime, on the 3D model simulator 30, after 
Ready Flag has been changed to A High' at step S706 of FIG. 
34, the procedure goes to step S707 to stand by until Loop 
5 Flag being transmitted from the embedded software 

developing section 40 is changed to A High' . In response 
to the fact that Loop Flag has been changed to *High' by 
the process of step S606 described above in connection with 
FIG. 32, the procedure goes to step S708 to change Ready 

10 Flag to x Low' , and then forward to step S702 to stand by 
until Loop flag is changed to ^Low' . If Loop Flag has been 
changed to *Low f as mentioned above, the procedure goes 
to step S703 where simulation for the simulation distance 
A t takes place . 

15 [0151] 

As the foregoing processes are repeated, the 
individual processes are executed by a multi-task while 
mutual synchronization is established between the 3D model 
simulator 30 and the embedded software developing section 
20 40 (the transition diagram or table creating program 320 
and the control program) . 

How to evaluate the possibility of mutual 
interference between the individual links (parts) will now 
be described. 

25 FIGS. 35(A) and 35(B) are diagrams illustrating how 

to evaluate the possibility of interference. In this 
example, a link A is moving toward a link B at a velocity 
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V . 

[0152] 

FIG. 35(A) shows two links (the link A and the link 
B) , which can interfere with each other, as being spaced 
5 far from each other. In this case, it is judged that the 
possibility of interference is small, so a relatively large 
value is set as the simulation distance At to increase 
the distance vAt, i.e. a unit distance by which the link 
Amoves in every simulation. This guarantees high-speed 
10 simulation, 
[0153] 

FIG. 35(B) shows the link A and the link B being spaced 
only a small distance from each other. In this case, it 
is judged that the possibility of interference is large, 
15 so a relatively small value is set as the simulation distance 

At to decrease the distance vAt, i.e. a unit distance 
by which the link A moves in every simulation. This 
guarantees high-precision simulation . 
[0154] 

20 Thus in the present embodiment, as the simulation 

distance At is changed in accordance with the distance 
between the individual parts, an inconsistency and harmony 
of high-precision simulation and high-speed simulation can 
be achieved . 

25 FIGS. 36(A) through 36(C) are graphs showing various 

kinds of relationships between the inter-part distance d 
and the simulation distance At. 
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[0155] 

In any one of the graphs of FIGS . 36(A) through 36 (C) , 
the simulation distance At is determined with respect to 
the inter-part distance d in such a manner that the 
5 simulation will not be reduced to a very lower rate even 
if the distance d is small and increased to a very higher 
rate even if the distance d is large. 
[0156] 

How to divide various parts into groups for evaluation 
10 of the possibility of interference will now be described 
with reference to FIGS. 37(A) and 37(B). 

In FIGS. 37(A) and 37(B), 6 links 1q through I5 are 
shown, a link I3, which is defined as a motor link and moves , 
is considered. 
15 [0157] 

In this case, the links to be influenced in posture 
due to the movement of the motor link I3 are links I3 through 
I5, which canbe regarded as a single rigid body with respect 
to the movement of the motor link I3. 
20 The links lo through 1 2 , which are not influenced in 

posture due to the movement of the motor link 1 3 , can be 
regarded as another single rigid body. 
[0158] 

To this end, for moving the motor link I3, as shown 
25 in FIG. 37(B), the remaining links are divided into two 
groups, one group of links whose postures are influenced 
by moving the motor link I3 and the other group of links 



whose postures are free of such influence, and such two 
groups are treated each as a single rigid body, whereupon 
the shortest distance between these two rigid bodies is 
obtained as a candidate to determine the next simulation 

5 distance A t . 
[0159] 

However, the link I3 and the link I2 (e.g., a shaft 
of the motor and a gear) in FIGS. 37(A) and 37(B) are 
separately incorporated in different groups, though they 
10 are normally in contact with each other; this is, the 
above-mentioned two rigid bodies virtually interfere with 
each other. 

Consequently, in the present embodiment, after the 
links are divided into two groups, the distance between 

15 the parts are obtained. And among the links already in 
engagement or interference with one another, at least one 
link (i.e., the link I2 in the example of FIGS. 37(A) and 
37 (B) ) belonging to one group whose individual links do 
not move when a currently noteworthy motor link is moved 

20 is excluded from that group, whereupon the two groups are 
individually treated as rigid bodies and then a distance 
between these two rigid bodies. 
[0160] 

FIGS. 38(A) through 38(D) are diagrams illustrating 
25 how to divide parts into groups (grouping) with a plurality 
of motor links defined in a single 
three-dimensional-mechanism model . 
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FIG . 3 8(A) shows a 3D model in which three motor links 
of motors Ml through M3 are defined. 

At that time, the three motor links are divided into 
groups, as described above in connection with FIGS. 37(A) 
5 and 37 (B) , for every time when only the motor Ml is moved 
(FIG. 38 (B) ) , when only the motor M2 is moved (FIG. 38 (C) ) , 
and when only the motor M3 is moved (FIG. 38(D)). 
[0161] 

During execution of the simulation, if an ob j ect motor 
10 link is moved, the shortest distance between the groups 
of the motor links is obtained, whereupon from plural 
candidate shortest distances obtained when the plural motor 
links are moved, the shortest distance is obtained (steps 
S201 through S207 in FIG. 21) . 
15 [0162] 

FIG. 39 is a diagram illustrating how to divide the 
grouped parts into new groups (regrouping). 

According to the method described above in connection 
with FIGS. 38(A) through 38(D), for each motor link, 

20 substantially all of the parts constituting the 3D model 
would belong to either group (rigid body) . As the result, 
the amount of data to define the individual rigid body would 
be huge, which would often require a very large memory 
capacity . 

25 [0163] 

Consequently, as shown in FIG. 39, among a set of 
parts belonging to the group (the group (D) , (E) or (F) 
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in FIG. 39) in which the individual parts do not move when 
each motor link is moved, a common portion is extracted 
as a single rigid body, and each group (D) , (E) or (F) 
excluded the common portion is treated as a single rigid 
5 body. And during the measuring of the distance, a rigid 
body of the common portion itself and a rigid body devoid 
of the common portion may be combined, and a distance from 
the companion group (i.e., the group (A), (B) or (C) 
corresponding to the group (D) , (E) or (F) ) maybe obtained. 

10 According to this alternative example, since data to define 
these individual groups is previously stored, it is 
possible to reduce the memory capacity as compared to the 
above-mentioned example (FIGS. 38(A) through 38(D)) in 
which a common portion is incorporated in each and every 

15 group. 
[0164] 

FIG. 40 is a flow diagram (steps S801 through S811) 
illustrating a routine of dividing a plurality of links 
into a group of those affected in posture by a movement 
20 of the motor link and a group of those free of being affected 
in posture by a movement of the motor link, and FIG. 41 
is a flow diagram (steps S901 through S911) illustrating 
a routine of retrieval of FIG. 40. 
[0165] 

25 In this example, some links whose postures are 

influenced by the movement of a motor link are entered in 
a list A, while the other links are entered in a list B. 
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These lists a and B are blanked out before executing the 
flow of processes being described here. 

As shown in FIG. 40, firstly a motor link (current 
link) is designated by a pointer P (step S801), and then 
5 the pointed motor link is added to the list A (step S802) . 
[0166] 

Then it is discriminated whether or not any child 
link exists with the individual link designated by the 
pointer P (step S803) . 

10 When the pointer P designates the motor link 1 3 in 

the link mechanism of FIGS. 37(A) and 37(B), the term "a 
child" means one of the links (link I4 here) which move 
together with the motor link 1 3 in response to movement 
of the motor link I3. In this example, even if the link 

15 I4 is a motor link, the currently noteworthy motor link 
is the link I3 and hence the link I4 is regarded as a child 
of the link I3. Even though a plurality of children 
identical in rank with the link designated by the pointer 
P could be considered, only one of the identical children 

20 is limited as being called "child", and in the meantime 
the remaining children are defined as "brothers" of such 
a single limited child. 
[0167] 

If the link designated by the pointer P has a child 
25 (YES route of step S803), the procedure goes to step s804 
where the pointer P is shifted so as to designate the child 
link so that a later-described retrieval routine of FIG. 
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41 is called (step S805). Upon completion of execution 
of the retrieval routine at step S805, the procedure goes 
to step S806. Otherwise, at step S803, if it is judged 
that the link designated by the pointer P has no child (NO 
5 route) , the procedure goes forward directly to step S806, 
skipping steps S804 and S805. 
[0168] 

At step S806, it is discriminated whether or not the 
link designated by the pointer P is a driving link for driving 

10 driven (passive) parts, such as gears and a cam. 

If the link designated by the pointer P is the driving 
link (YES route) , the procedure goes to step S807 where 
the pointer P is shifted so as to designate a driven link 
(passive part) that is to be driven by the link designated 

15 by the pointer P so that the retrieval routine of FIG. 41 
is called at step S808. Upon completion of execution of 
the retrieval routine at step S808, the procedure goes to 
step 809. Otherwise, at step S806, it is judged that the 
link designated by the pointer P is not the driving link 

20 for the driven (passive) parts (NO route), the procedure 
goes forward directly to step S809, skipping steps S807 
and S808. 
[0169] 

At the time the procedure has went forward to step 
25 S809, the list A has already completed, and all the links 
except those included in the list A are stored in the list 
B. 
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Then an interference check is made between all the 
links included in the list A and all the links included 
in the list B (step S810) , whereupon from a set of companion 
links interfering each other, one companion link included 
5 in the list B is removed from the list B (step S811) . 
[0170] 

In the retrieval routine of FIG. 41, firstly at step 
S901 , it is discriminated whether or not the link designated 
by the pointer P has already been included in the list A. 

10 If it has already been included in the list A (YES route) , 
the procedure returns directly to the original routine, 
in which the retrieval routine was called, skipping the 
ret rieval rout ine . Otherwise, atstepS901, if it is judged 
that the link designated by the pointer P has not been 

15 included in the list A (NO route) , the procedure gores to 
step S902 where the link designated by the pointer P is 
added to the list A. 
[0171] 

At step S903, it is discriminated whether or not the 
20 link designated by the pointer P has a child. If the link 
designated by the pointer P has a child (YES route) , the 
procedure goes to step S904 where the pointer P is shifted 
so as to designate the child link, and then forward to step 
S905 wherein the retrieval- routine of FIG. 41 is called 
25 again. In this manner, this retrieval routine is often 
repeatedly called; upon completion of execution of the 
retrieval routine, the procedure returns to the step (e.g., 
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step S905 when called at step S905) in which the retrieval 
routine has been called. Upon completion of execution of 
the retrieval routine at step S905, the procedure goes to 
step S906. Otherwise, at step S903, if the link designated 
5 by the pointer P has no child as the result of discrimination 
(NO route), the procedure goes forward directly to step 
S906, skipping steps S904 and S905. 
[0172] 

At step S906, it is discriminated whether or not the 
10 link designated by the pointer P has brother (s) . If the 
designated link has brother (s) (YES route) , the procedure 
goes to step S907 where the pointer P is shifted so as to 
designate the brother link(s), and then forward to step 
S908 where the retrieval routine is called again. Upon 
15 completion of execution of the retrieval routine, the 
procedure goes to step S909. Otherwise, at step S906, if 
the designated link has no brother as the result of 
discrimination (NO route) , the procedure goes forward 
directly to step S909. 
20 [0173] 

At step S909, it is discriminated whether or not the 
link designatedby the pointer Pis a driving link for driving 
the driven (passive) parts, such as gears and a cam. If 
the designated link is a driving link as the result of 
25 discrimination (YES route) , the procedure goes to step S910 
where the pointer P is shifted so as to designate the driving 
link, and then forward to step S911 where the retrieval 



routine is called again. Upon completion of execution of 
the retrieval routine at step S911, the procedure returns 
to the step where the retrieval routine was called. 
Otherwise, at step S909, if the designated link is not the 
5 driving link as the result of discrimination (NO route) , 
the procedure returns back directly to the step where the 
retrieval routine was called. 
[0174] 

FIG. 42 is a perspective diagram of a link mechanism 
10 model for explaining operation of the routines of FIGS. 
40 and 41; and FIG. 43 is a diagram illustrating a data 
structure of the link mechanism model of FIG. 42. 

As shown in FIG. 42, the link A is a motor; the links 
B and C, a shift and a gear, respectively, which corotate 
15 as the link A (motor) rotates ; and the link D, a gear meshing 
with the link C. And the link E is a shaft which corotates 
with the link D (gear) as the last-named link rotates, and 
the link F is a gear meshing with the link D (gear) . 
[0175] 

20 In data structure, as shown in FIG. 43, the link A, 

the link D and the link F are arranged in parallel; the 
link B is a child of the link A, the link C is a brother 
of the link B, and the link E is a child of the link D. 

For the link mechanism model of FIGS. 42 and 43, it 

25 is considered to create the list A by executing the routine 
of FIGS. 40 and 41. In this example, the retrieval routine 
starts with the link A (motor) . Namely, first of all, the 
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pointer P makes a designation so as to select the link A 
at step S801 of FIG. 40. In the following explanation of 
the retrieval routine, each capital alphabetical letter 
in ( ) represents an individual link included in the list 
5 A. 

[0176] 

(1) With the pointer P designating the link A, the 
retrieval routine starts off. (A) 

(2) The pointer P is shifted from the link A to the 
10 link B, which is a child of the link A, and the retrieval 

routine is executed. (A, B) 

(3) The pointer P is shifted from the link B to the 
link C, which is a brother of the link C, and the retrieval 
routine is executed. (A, B, C) 

15 (4) The pointer P is shifted to the link D, which 

is a driven (passive) part of the link C, and the retrieval 
routine is executed. (A, B, C, D) 

(5) The pointer P is shifted from the link D to the 
link E, which is a child of. the link D, and the retrieval 

20 routine is executed. (A, B, C, D, E) 

(6) The pointer P is shifted back to the link D by 
returning from the retrieval routine. 

[0177] 

(7) The pointer P is shifted from the link D to the 
25 link F, which is a driven (passive) part of the link D, 

and the retrieval routine is executed. (A, B, C, D, E, 
F) 
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(8) The pointer P is shifted back the link D by 
returning from the retrieval routine. 

(9) The pointer P is shifted back the link C by 
returning from the retrieval routine. 

5 (10) The pointer P is shifted back the link B by 

returning from the retrieval routine. 
[0178] 

(11) The pointer P is shifted back the link A by 
returning from the retrieval routine. 
10 (12) The retrieval routine ends. 

In the foregoing procedure, all the links (links A 
through F) of FIG. 42 are entered in the list A. 

How to evaluate the possibility of interference in 
the group of links whose postures are changed due to the 
15 movement of a single motor link will now be described. 
[0179] 

The interference due to the movement of the motor 
link, as described above in connection with FIGS. 37(A) 
and 37 (B) , can occur not only between the group of the links 

20 whose postures are influenced by the movement of the motor 
link and the group of those whose postures are not influenced 
by the movement of the motor link, but also within the group 
of those whose postures are influenced by the movement of 
the motor link as shown in FIG. 42. 

25 [0180] 

Consequently, for finding a set of companion links 
which are possible to interfere each other in the group, 
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an interference check is made between all the individual 
links in the group, whose postures are influenced by the 
movement of the motor link, before the start of simulation, 
while the motor link is moved little by little. By making 
5 such interference check for each and every possible 

companion link sets, the companion link set will be not 
only a candidate, whose distance is to be obtained for the 
forthcoming actual simulation, but also a candidate for 
the shortest distance by which the simulation distance A 
10 t (=Ts) is determined. Precise simulation can therefore 
be achieved. 
[0181] 

However, in the group in which the postures of the 
individual links are influenced by the movement of the motor 

15 link, yet a set of companion links normally in contact with 
each other exists like the motor and gear of FIG. 42. 
Consequently, after the interference check has made as the 
motor link is moved little by little, any companion link 
set, in which the companion links normally interfere with 

20 and are in contact with each other for every posture of 
the motor link, e.g., a set of companion links 
interconnected by a gear or the like is excluded from the 
object links between which distance is obtained. 
[0182] 

25 FIGS. 44 (A) through 44 (D) are diagrams specifically 

illustrating how to extract combinations of links for 
obtaining inter-link distances during simulation in the 
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group of the links affected in posture by a movement of 
the motor link. 

FIG. 44 (A) shows all parts composing a group in which 
the postures of the individual parts vary due to the movement 
5 of a particular single motor. In an illustrative example 
shown in FIG. 44(B), while the motor is turned 
intermittently by a pitch of 36 degrees from -180 to 180 
degrees, an interference check is made for each and every 
36-degree movement. In this case, the individual turn of 
10 the motor and the interference check are performed eleven 
times . 
[0183] 

As a result, a set of interfered links and the 
frequency of occurrence of interference as shown in FIG. 

15 44(C) are obtained. The inter ference check was made eleven 
times; since the interference between the links B and E 
and that between the links D and E occurred eleven times 
(normally interfere or in contact with each other) , these 
two sets are excluded from the object sets whose inter-link 

20 distances are to be measured during simulation as shown 
in FIG. 44 (D) . 
[0184] 

A 3D model simulator 30, which constitutes the support 
system 10 of the present invention, according to a second 
25 embodiment will now be described with reference to FIGS. 
45 through 64. 

FIG. 45 is a flow diagram illustrating the whole 
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simulation procedure by a 3D model simulator 30 according 
to the second embodiment of the present invention . As shown 
in FIG. 45, a synchronization process between the 3D model 
simulator 30 and the embedded software developing section 
5 40 (step S1001), a motor process (step S1002), a joint 
malfunction process (step S1003) , a sensor process (step 
S1004), and a process of determining the execution time 

AT (=Ts) of the embedded software developing section 40 
(step S1005) , are repeatedly executed. 
10 [0185] 

The synchronization process between the 3D model 
simulator 30 and the embedded software developing section 
40 (step S1001) is similar to the synchronization process 
described above in connection with FIGS. 12 through 14 and 

15 32 through 34, so its description is omitted here. The 
remaining processes will now be described. 

FIG. 46 is a flow diagram illustrating a motor 
processing routine. In the flow diagram of FIG. 46, a 
motor-trouble concept is incorporated in the motor process 

20 of the first embodiment, which is constituted basically 
by a portion surrounded by a dash-and-dot line in FIG. 21. 
[0186] 

As shown in FIG. 46, at step S1101, firstly <*> is 
initially input for the shortest distance D before 
25 obtaining the shortest distance D, and then it is 

discriminated, at step S1102, whether or not there exist 
any unprocessed motors . If such unprocessed motors exist 
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(YES route), the processes of steps S1103 through S1110 
are performed for each and every unprocessed motor. 
[0187] 

Thus, first of all, for the individual unprocessed 
5 motor, it is discriminated whether or not the motor is out 
of order (step S1103) ; presence/absence of motor troubles 
are previously set by the user and are preserved as flags. 

No process is performed for the motor which is out 
of order (YES route of step 1103 to step S1102), and for 
10 the motor which is free of any trouble (NO route of step 

S1103), the posture change amount A 6 of the motor is 
determined in accordance with an actuator instructing 
signal related to the motor being currently processed, 
which signal is transmitted from the embedded software 
15 developing section 40 (step S1104). 
[0188] 

It is discriminated whether or not A 0=0. If A 6 
=0 (YES route), the procedure returns to step S1102. 
Otherwise if not A 0=0 (NO route) , the current change amount 

20 A 6 is added to the preceding posture 9 of the motor (step 
S1106) . A link posture varying subroutine (described 
later in connection with FIG. 47) for calculating the 
posture change amount of the link, which is moved when the 
motor link is moved, is executed (step S1107) . 

25 [0189] 

Subsequently, the inter-part shortest distance d is 
obtained (step S1108) , and it is discriminated whether or 
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not d<D (step S1109) . If not d<D (NO route) , the procedure 
returns tostepS1102. Otherwise if d<D (YES route) , namely, 
when the currently obtained shortest distance d is shorter 
than the previously obtained shortest distance D, the 
5 currently obtained shortest distance d is substituted for 
the shortest distance D to update the last-named distance 

(step S1110) . 

[0190] 

Further, for all the motors, upon completion of 
10 posture variation during the current arithmetic time A 
T, this motor process is terminated. 

FIG. 47 is a flow diagram illustrating a link posture 
varying subroutine (step S1107) shown in FIG. 46. 

As shown in FIG. 47, in the link posture varying 
15 subroutine, first of all, in response to the link posture 
variation (the posture variation of the motor link when 
called at step S1107 of FIG. 46) (step S1201), it is 
discriminated whether or not there exists any uncalculated 
driven link within the driven links that are passive with 
20 respect to the links whose postures have been varied (step 
S1202) . 
[0191] 

If the unprocessed driven link exists (YES route), 
it is discriminated whether or not a clutch exists between 
25 the link whose posture has currently varied and the driven 
link which is passive with respect to the posture- varied 
link (step S1203) . If the clutch exists (YES route), it 
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is discriminated whether or not the posture of the clutch 
part is in on position (step S1204) . The presence of the 
clutch part, and the relationship between the posture of 
the clutch part and the on/off of the clutch are previously 
5 defined by the user. 
[0192] 

If no clutch part exists (NO route of step S1203) 
or if, though it exists, the clutch part is in on position 
(YES route of step S1204) , the procedure goes to step S1205 

10 where the amount of movement of a driven part is calculated 
based on the relationship with gears or cam. Then at step 
S1206, for obtaining the amount of movement of a driven 
part with respect to the driving part if the driven part 
for which the current movement amount is calculated is 

15 regarded as driven part, the link posture varying 

subroutine is called again, and this subroutine is executed, 
whereupon the procedure returns to step S1202 . Otherwise, 
at step S1204, if the clutch part is not on position as 
the result of discrimination (NO route) , the procedure 

20 returns directly to step S1202. 
[0193] 

In this manner, the link posture varying subroutine, 
likewise the retrieval routine of FIG. 41, is reflexively 
executed so that the amount of movement of the other parts 
25 can be obtained at an increased rate when a single motor 
is moved. 

FIG. 48 is a flow diagram illustrating a joint 



malfunction processing routine to be executed at step S1003 

of FIG. 45. 

[0194] 

As shown in FIG. 48, in the joint malfunction 
5 processing routine, first of all, after the 

three-dimensional-mechanism model is displayed on the 
screen (step S1301), it is sequentially discriminated 
whether or not the user has designated a newly fault link 
(step S1302) , whether or not there exist unprocessed fault 
10 links designated by the user (step S1305) , whether or not 
there exist unprocessed links encountered interference 
(step S1310) , and whether or not there exists a fault link 
(step S1314) . 
[0195] 

15 At step S1302, if it is judged that the user has newly 

designated a fault link (YES route) , the procedure goes 
to step sl303 where a motor driving the newly designated 
fault link, and the motor and the direction of movement 
of the motor are added to the list (step S1304) , whereupon 

20 the procedure goes forward to step S1305. 

If it is judged at step S1305 that the unprocessed 
fault link, which is designated by the user, exists (YES 
route), the procedure goes to step S1306 where it is 
discriminated whether or not the direction of movement of 

25 the motor driving the fault link has been reversed. If 
the direction of movement of the motor has not been reversed 
(NO route) , the procedure goes to step S1307 where the motor 



recovers its original posture. To restore the original 
posture of the link in response to that the motor restores 
its original posture, the link posture varying subroutine 
of FIG. 47 is called and executed (step S1308), whereupon 
5 the procedure returns to S1305. Otherwise, at step S1306, 
it is judged that the direction of movement of the motor 
has been reversed (YES route), the procedure goes to step 
S1309 where the motor is deleted from the fault link list, 
and then the procedure returns to step S1305. 
10 [0196] 

As a result, a movement such that the fault link 
becomes unable to move as caught for any cause when it is 
intended to move in one direction, and the fault link then 
restores its normal condition as released from the catch 

15 when the fault link is once moved in opposite direction, 
is simulated. 

At step S1310, if it is judged that the unprocessed 
link, with which interference has occurred, exists (YES 
route), the procedure goes to step S1311 where a motor 

20 driving the fault link is retrieved, and the original 
posture of the motor is restored (step S1312) . To restore 
the original posture of the other link to be driven by the 
motor, the link mechanism subroutine of FIG. 47 is called 
and executed (step S1313) , whereupon the procedure returns 

25 to step S1310. 
[0197] 

As a result, it is possible to simulate a situation 
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such that a particular link becomes unable to move further 
as interfered with another link. 

At step S1314, it is discriminated that the fault 
link exists (YES route) , the three-dimensional mechanism 
5 model is described again on the screen (step S1315) . 
Accordingly, by observing the result of redrawing of the 
three-dimensional-mechanism model, together with the 
drawing at step S1301, the motor, which has the fault link 
as the driven part, and the movements of all links, which 
10 are to be driven by the motor, are displayed in unnatural 
manner (e.g., non-smoothly or irregularly). 
[0198] 

In this illustrated example, the joint malfunction 
status is realized by restoring the original posture of 
15 the motor . Alternatively the joint ma 1 function status may 
be realized by setting the upper limit or lower limit of 
the joint value temporarily to a current value. 

FIG. 49 is a flow diagram illustrating a sensor 
processing routine to be executed at step S1004 of FIG. 
20 45 . 

[0199] 

In the foregoing embodiment, the sensor is an on/off 
sensor which outputs on and off signals. In this example, 
the sensor should by no means be limited to such on/off 
25 sensor, and may be in the form of a potentiometer or an 
encoder. Also the sensor trouble is considered. 

As shown in FIG. 49, first of all, in step S1401, 
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presence /absence of an unprocessed sensor is discriminated . 
If an unprocessed sensor exists (YES route) , the procedure 
goes to step S1402 where it is discriminated whether or 
not the unprocessed sensor is an on/off sensor. If the 
5 unprocessed sensor is an on/off sensor (YES route), the 
on/off sensor process is performed at step S1403, and a 
sensor value (on or off) , as the result of processing the 
on/off sensor is output, whereupon the procedure returns 
to step S1401. 
10 [0200] 

At step S1402, if it is judged that the unprocessed 
sensor is not an on/off sensor (NO route) , the procedure 
goes to step S1404 where it is judged whether or not the 
sensor is a potentiometer. If it is a potentiometer (YES 

15 route), the procedure goes to step S1405 where a 

potentiometer preprocess is performed. Then at step S1406 
an encoder process is performed and a sensor value as the 
result of the encoder process is output, whereupon the 
procedure returns to step S1401. 

20 [0201] 

Otherwise if it is judged that the sensor is not a 
potentiometer (NO route) , namely, if it is judged that the 
sensor is an encoder, the procedure goes forward directly 
to the encoder process of step S1406, and a sensor value 
25 as the result of the encoder process is output, whereupon 
the procedure returns step S1401. 

FIG. 50isa flow diagram illustrating an on/off sensor 
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processing routine to be executed at step S1403 of FIG. 
49. 

[0202] 

In this on/off sensor process routine, the on/off 
sensor trouble also is simulated. As shown in FIG. 50, 
first of all, it is discriminated, at step S1501, whether 
or not the on/off sensor is out of order with keeping in 
the on status, and it is discriminated, at step S1503, 
whether the on/off sensor is out of order with keeping in 
the off status. 
[0203] 

If the on/off sensor is out of order with keeping 
in the on status (YES route of step S1501), on is set as 
an estimated output value (step S1502) . If the on/off 
sensor is out of order with keeping in the off status (YES 
route of step S1503) , off is set as an estimated output 
value (step S1504), and the procedure goes to step S1508 
where the estimated output value is output as a sensor value . 
It is previously set by the user whether or not the on/off 
sensor is out of order with keeping in the on status or 
the off status . 
[0204] 

If the on/off sensor is not out of order (NO route 
of steps S1501 and S1503) , the procedure goes to step S1505 
where the estimated output value (on or off) is determined 
from the posture of the sensor link (step S1505) . 
Subsequently an estimated output value change process due 
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to performance inferiority (step S1506) and an estimated 
output value change process by chattering (stepS1507) are 
executed, whereupon the procedure goes forward to step 
S1508 . 
5 [0205] 

FIG, 51 is a flow diagram illustrating a sensor 
performance inferiority processing routine which is to be 
executed at step S1506 of the on/off sensor process routine 
of FIG. 50. In this sensor performance inferiority 

10 processing routine, the following situation is simulated: 
when there happens to occur an abnormal status such as to 
change the output of the on/off sensor from off to on, or 
vice versa due to inferior response performance, the 
previous status (off or on) is kept for a while, namely, 

15 the output of the on/off sensor delays to change the on/off 
status . 
[0206] 

As shown in FIG. 51, first of all, at step S1601, 
it is discriminated whether or not an estimated output value 

20 is equal to an estimated original output value d. If a 
change has occurred (NO route) , the procedure goes to sep 
SI 602 where it is discriminated whether or not the estimated 
output value is on. If the estimated output value is on 
(YES route) , the procedure goes to step S1603 where a delay 

25 time when the sensor output changes from off to on is set 
to Td, whereupon the procedure goes forward to step S1605. 
Otherwise if the estimated output value is off (NO route 
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of step S1602), the procedure goes to step S1604 where a 
delay time when the sensor output changes from on to off 
is set, whereupon the procedure goes forward to step S1605. 
[0207] 

5 At step S1601, if it is judged that the estimated 

output value is equal to the original estimated output value 
d (YES route) , or upon completion of the processes of steps 
S1603 and S1604, then it is discriminated at step S1605 
whether Td>0. If Td>0 (YES route), the procedure goes to 

10 step S1606 where an execution time AT of the embedded 
software developing section 40 is subtracted from Td, and 
then forward to step S1607 where the estimated output value 
is inverted (off when the estimated output value is off, 
and on when the estimated output value is off) , whereupon 

15 the procedure goes forward to step S1608. 
[0208] 

At step S1605, if not Td>0 (NO route), or upon 
completion of the process of step S1607, the procedure goes 
to step S1608 where the current estimated output value is 
20 stored to update the original estimated value d. 

As shown in FIG. 45, the sensor process of S1004 is 
repeatedly executed, and the sensor performance 
infer iority process of FIG. 1 also is repeatedly executed. 
And when Td>0, AT is subtracted from Td each time this 
25 process is repeated; the sensor will not be varied until 

Td^ 0 . 
[0209] 
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FIG. 52 is a flow diagram illustrating an estimated 
output value change processing routine, which is to be 
executed by step S1507 of the on/off sensor processing 
routine of FIG. 50, by chattering. In this estimated value 
5 change processing routine, chattering when the on/off 
sensor changes from on to off, or vice versa, is simulated. 

As shown in FIG. 52, first of all, at step S1701, 
it is discriminated whether or not the estimated output 
value is equal to the original estimated output value. If 

10 a change has occurred (NO route) , the procedure goes to 
step S1702 where it is discriminated whether or not the 
estimated output value is on. If the estimated output is 
on (YES route), the procedure goes to step S1703 where a 
chattering time when the sensor output changes from off 

15 to on is set to Tc, whereupon the procedure goes forward 
to step S1705. Otherwise if the estimated output value 
is off (NO route of step S1702) , the procedure goes to step 
S1704 where a chattering time when the sensor output changes 
from ontooffsettoTc, whereupon the procedure goes forward 

20 to step S1705. 
[0210] 

At step S1705, the estimated output value is set to 
update the original estimated output value c. After 
completion of this process or if it is judged at step S1701 
25 that the estimated output value is equal to the original 
estimated output value c (YES route) , the procedure goes 
to step S1706 where it is discriminated whether or not Tc>0 . 
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If TOO (YES route) , the procedure goes to step S1707 
where the execution time AT of the embedded software 
developing section 40 is subtracted from Tc, and then 
forward to step S1708 where a random number representing 
5 one of 0 to 9 9, which has occurred, is compared with a preset 
possibility of occurrence (a value representing one of 0 
to 99) . As the result, if random number > possibility of 
occurrence (YEST route) , the estimated output value (on 
or off) is inverted (step S1709) , whereupon the process 
10 is terminated. Otherwise, at step S1708, if not random 
number > possibility of occurrence (NO route) or if not 
Tc>0 (NO route) at step S1706, whereupon the process is 
terminated without advancing to another step. 
[0211] 

15 Thus, while Tc>0, chattering such as to change from 

on to off, or vice versa in possibility is simulated. 

The encoder process to be executed at step S1406 of 
FIG. 49 will now be described. 

FIG. 53 is a graph showing one example of output 
20 waveform with respect to the variation (e.g., angle) of 
an encoder, and FIGS. 54(A) through 54(E) are diagrams 
showing various output waveforms of an encoder. 
[0212] 

Now, as shown in FIG. 53, assume a situation that 
25 the output waveform of an encoder is a periodic function 
f ( 9 ) having a wavelength L. The function f ( 9 ) can have 
selectively various kinds of waveforms such as shown in 
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FIGS. 54(A) through 54(E). The wavelength L corresponds 
to a single cycle of the function f ( 6 ) ; assuming that this 
encoder is a rotary encoder and outputs a single-period 
signal every turn of 1.0 degree, L=1.0 (degrees). 
5 [0213] 

If the change 9 is converted into an electrical angle 
<t> -2 k d /L, the function f ( 6 ) is assumed to be expressed 
as function g ( <j> ) ; the principle of the encoder function 
will now be described. 

10 Assuming that the electrical angle of the encoder 

during the previous simulation is <f>Q, namely, the 
electrical angle at the time advanced from the previous 
simulation by the arithmetic time AT of the embedded 
software developing section 40 is <f> , and the electrical 

15 angular velocity of the encoder is co , the amount of movement 
of the encoder in a simulation cycle from the previous 

simulation to the current simulation will be co AT, thus 
establishing 

<f> = <f> o+ At. 

20 [0214] 

However, in measuring the number of pulses, the 
encoder has to output g ( <f> ) after output ting a predetermined 
number of pulses because it cannot merely output g( <t> ) if 
co AT in the current simulation cycle is larger than 2 
25 7i . 

FIG. 55 is a flow diagram illustrating an output 
processing routine of an encoder. 
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[0215] 

In the encoder output processing routine, as shown 
in FIG . 55, firstly the encoder output g { 4> q) upon 
termination of the previous simulation is output (step 
5 S1801). Then it is discriminated whether or not a 

difference <j> - <t> q between the electrical angle <£> upon 
termination of the current simulation and the previous 
electrical angle <t> q is <t> - <f> q> k /2 (step S1802), or it is 
discriminated whether or not <p q~ <f> > n / 2 (step S1804). 
10 [0216] 

If $ - <t> q> 7z /2 (YES route of step S1802 ) , theprocedure 
goes to stepS1803 where n /2 is added to 4> q, and then forward 
to step S1806 where the procedure stands by for 50 jj, sec, 
whereupon the procedure returns to step S1801 where g ( <f> 

15 q) fornew $ q Is output . If <f> q- <£> > n / 2 (YES route of step 
S1804), the procedure goes to step S1805 where tz/2 is 
subtracted from<f>0/ and then forward to step S1806 where 
the procedure stands by for 5 \x sec, whereupon the procedure 
returns to step S1801 where g ( 4> q) for new (j> $ is output. 

20 [0217] 

Namely, if | <t> - <f> q | > n /2 , a dispers ing per iodic signal 
when <f> varies at a pitch of n /2 until | <t> - <t> q \ ^ n /2 with 
the upper limit set to a frequency of 5 kHz (step S1806) . 

If \ $ - 4> o \ ^ 7i /2 (NO route of steps SI 8 02 and SI 804) , 
25 the procedure goes to step S1807 where g( 0 ) , which is the 
final value of the encoder in the previous simulation, is 
output so that <t> of the current simulation is updated as 
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current <f> q for the next simulation (step S1808). 
[0218] 

It is assumed that this encoder signal is received 
by a counter circuit which operates independently of the 
5 embedded software developing section 40 so that no problem 
would occur even when the embedded software developing 
section 40 is stopped during the transmitting of the encoder 
signal . 

The flow diagram of FIG. 55 shows an encoder of the 
10 type of outputting only a single pulse signal q { <j> ) . 

Alternatively, g ( <f> + n /2 ) may be output so that an encoder 
of the type of outputting a two-phase signal of A phase 
and B phase can be expressed. 
[0219] 

15 As another alternative, a positive/negative signal 

of <j> - (£> o may be output in terms of on/off so that an encoder 
ofthetypeof outputting an up /down signal can be expressed . 

For preparation of the above-mentioned simulation, 
an offset indicating a zero position, in which a waveform 

20 of pulse (FIGS. 54(A) through 54(E)), resolution or 
electrical angle <f> becomes zero (0), so that the 
characteristics of an encoder can be defined by the user. 
[0220] 

FIG. 56 is a flow diagram illustrating an encoder 
25 processing routine which is to be executed at step S1406 
of the process routine of FIG. 49. 

Here the encoder trouble also is considered; for 



110 



simulating a three-dimensional-mechanism model when the 
encoder is out of order, the following fault flags 0 through 
6 are previously set: 
. [0221] 

5 Fault flag 0: normal 

Fault flag 1: A phase trouble at V max 
Fault flag 2: A phase trouble at V m i n 
Fault flag 3: B phase trouble at V max 
Fault flag 4: B phase trouble at V m i n 
10 Fault flag 5: up/down signal trouble (fixed to High) 

Fault flag 6: up/down signal trouble (fixed to Low) 
As shown in FIG. 56, first of all, at step S1901, 
the change 6 is converted into an electrical angle , and 
then it is discriminated whether or not the fault flag is 
15 1 (step S1902) , and it is discriminated whether or not the 
fault flag is 2 (step S1903) . If the fault flag is neither 
1 nor 2, the procedure goes forward to step S1904 where 

the g ( <f> ) output process routine of FIG. 55 is executed. 
[0222] 

20 Otherwise, at step S1902, if it is judged that the 

fault flag is 1, the procedure goes to step S1905 where 

g(7c/4)/ which corresponds to the phase trouble at V max , 

is output. In the meantime, at step S1903, if it is judged 

that the fault flag is 2, the procedure goes to step S1906 

2 5 where g (3 n / 4 ) , which corresponds to the phase trouble at 
V min , is output. 

[0223] 
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Subsequently, at step S1907, it is discriminated 
whether or not the encoder is an encoder of the 
two-phase-output type, and at step S1908, it is 
discriminated whether or not the encoder is an encoder of 
5 the type of outputting an up/down signal. If the encoder 
is neither type, namely, if the encoder is an encoder of 

the type of merely outputting only g ( <M this routine is 

skipped . 

[0224] 

10 At step S1907, it is judged- that the encoder is the 

two-phase-output- type encoder, the procedure goes to step 
S1909 where it is discriminated whether or not the fault 
flag is 3, and then forward to step S1910 where the fault 
flag is 4 . If the fault flag is neither 3 nor 4, the procedure 

15 goes to step S 1911 where the output processing routine 

inwhich 0 + n /2 is substituted for in FIG. 55 is executed. 
[0225] 

At step S1909, if it is judged that the fault flag 

is 3, the procedure goes to step S1912 where g ( it /4) , which 
20 corresponds to B phase trouble at V max , is output. Likewise, 

at step S1910, if it is judged that the fault flag is 4, 

the procedure goes to step S1913 where g(37t/4), which 
corresponds to B phase trouble at V m i n , is output. 

[0226] 

25 Further, at step S1908, if it is judged that the 

encoder is an encoder of the type of outputting an U/D 
(up/down) signal, the procedure goes to step S1914 where 
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it is discriminated whether or not the fault flag is 5, 
and then forward to step S1915 where it is discriminated 
whether or not the fault flag is 6. 

If the fault flag is neither 5 nor 6, the procedure 
5 goes to step S1916 where it is discriminating in which 
direction the encoder is moved. If the moving direction 
is upward (U route) , the procedure goes to step S1917 where 
^High' is output. Otherwise if the moving direction is 
downward (D route) , the procedure then goes to step S1918 
10 where x Low f is output. 
[0227] 

At step S1914, if it is judged that the fault flag 
is 5, the procedure goes to step S1917 where ^High' is output, 
irrespective of the direction of moving of the encoder. 
15 Likewise, at step S1915, if it is judged that the fault 
flag is 6, the procedure goes to step S1918 where x Low' 
is output, irrespective of the direction of moving of the 
encoder . 
[0228] 

20 Thus not only the encoder type but the encoder trouble 

can be expressed. In the case of encoder, unlike the case 
of on/off sensor, when outputting a sensor signal, judging 
and processing of fault flags are performed when outputting 
a sensor signal, instead of showing "occurrence of trouble" 

25 immediately after the processing has been started. 

FIG. 57 is a diagram illustrating one example of 
function value of a potentiometer . Here the potentiometer 
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is in the form of an encoder which outputs a triangular 
wave of FIG. 54 (D) and is very low in resolution. Assuming 
that the wavelength L of FIG. 53 is set to 360 degree, it 
is possible to express a potentiometer which converts the 
5 output voltage V of varying range of 0 max - 0 min =180 degrees 
from the minimum value V m i n from the maximum value V max/ 
as shown in FIG. 57. 
[0229] 

FIG. 58 is a flow diagram illustrating a potentiometer 
10 preprocessing routine to be executed at step S1405 of the 

sensor process routine shown in FIG. 49. 

In the case of potentiometer, as indicated by a solid 

line in FIG. 57, a potentiometer is realized such that, 

for 0 equal to or smaller than 0 m i n , the output voltage 
15 V is fixed to the minimum value, and for 0 equal to or 

larger than 0 max , the output voltage V is fixed to the 

maximum value, as shown in FIG. 58. 

[0230] 

Namely, as shown in FIG. 58, at step S2001, it is 
20 discriminated whether or not 0 > 0 max is satisfied; if it 

is satisfied, the procedure goes to step S2002 where 0 
is fixed to 0 max . 

Likewise, at step S2003, it is di scriminated whether 
or not 0 < 0 min is satisfied; if it is satisfied, the 
25 procedure goes to step S2004 where 0 is fixed to 0 m in- 
[0231] 

In the case of potentiometer, after the foregoing 
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preprocess has been performed, the encoder process of FIG. 
56 is executed (FIG. 49). 

In this type potentiometer, when the user inputs d 
min'^max' v min' v max' the support system automatically 
5 converts each of these input values into a wavelength, an 

amplitude and an offset of a triangular wave f (6 ) . 
[0232] 

A potentiometer, such as a stopper-less 
potentiometer, whose output periodically varies, is 
10 treated as an encoder which outputs a triangular wave and 
a sawteeth wave which are low in resolution. 

FIG. 59 is a flow diagram illustrating a AT 
determination processing routine (inter-simulation 
distance determination processing routine) to be executed 
15 at step S1005 of FIG. 45. 
[0233] 

As shown in FIG. 59, first of all, at step S2101, 
it is discriminated whether or not there exists any sensor 
in which performance inferiority (response delay or 

20 chattering) has occurred. If no such sensor exists, A 
T corresponding to the shortest inter-part distance D 
obtainedby the process of FIG. 4 6 i s determined (stepS2102) . 
Otherwise if such sensor exists, a possible minimum value 
for AT is set (step S2103). 

25 [0234] 

Thus by setting A T to a minimum value when a sensor 
in which performance inferiority has occurred exists, it 
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is possible to increase the degree of precision in 
expressing performance inferiority and hence to realize 
accurate simulation. In the case of a normal sensor, since 
a delay time is previously set to zero, the sensor operates 
5 without any problem. 

FIGS. 60(A) and 60(B) are diagrams illustrating 
how to retrieve a joint movement range by an interference 
check . 
[0235] 

10 First of all, the user selects as to which direction 

the user intends to set a restricting value or as to which 
set of parts will cause a restriction to occur as they contact 
each other, whereupon a joint movable range is retrieved. 

In retrieving this joint movable range, the joint 

15 posture x is increased from the initial value xq 

intermittent ly by a pitch of Ax, and an interference check 
is made for every increment. As a result, as shown in FIG. 
60(A), when x=XQ + nAx, no interference occurs, and when 
the next x= x=xg+(n+l) Ax, it turns out a position an 
20 interference occurs. 
[0236] 

Subsequently, by using an amount of movement Ax' 
smaller than Ax, e.g. Ax' = Ax/10, as shown in FIG . 60(B), 
x is increased from xq+Ax intermittently by a pitch of 
25 Ax' . When x=XQ + nAx+n' Ax' , no interference occurs, and 
when the next x= x^xg + n A x+ (n' + 1 ) A x' , it turns out a 
position an interference occurs. 
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By repeating the foregoing process several times, 
it is possible to obtain a restricting value next XQ+n 

Ax + n' A x' +n" A x" . . . at high speed with desired precision. 
But, two parts designated by the user might be in such a 
5 position relationship as not to interfere each other in 
whichever way the joints are moved consequently, it is 
preferable to set the upper limit for the frequency of 
retrievals n when performing the first interference 
position retrieval, so that an infinite loop can be 
10 prevented. 
[0237] 

FIGS. 61(A) through 61(C) are diagrams illustrating 
how to retrieve a cam relation by an interference check, 
and FIG. 62 is a flow diagram illustrating a cam relation 

15 retrieving routine by an interference check. 

Here, such as shown in FIGS. 61(A), a driving 
(positive) part PI, a driven (passive) part P2, an initial 
posture of the driving part PI, an initial posture of the 
driven part P2, and a final posture of the driving part 

20 PI are previously designated by the user. 
[0238] 

In the routine of FIG. 62, first of all, the initial 
posture of the driving part PI and the initial posture of 
the driven part P2 are set to <f> and <i> , respectively (step 
25 S2201) , and then a non-contact posture of the driven part 
P2 is retrieved and is stored as </> (step S2202) . 

Subsequently, at step S2203, a set of the posture 
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<t> of the driving part PI, the non-contact posture <i> of 
the driven part P2 , which have cur rently obtained, are 
registered so that the posture 4> of the driving part 
PI is moved by A (f> such as shown in FIG. 61(B) (stepS2204). 
5 [0239] 

Further, the process of retrieving and arithmetic- 
operating the non-contact posture </> (FIG. 61(C)) of the 
driven part P2 with respect to the driving part PI moved 
intermittent at a pitch of A 0 (step S2202) , the process 
10 of registering the postures <£> , <J> (step S2203), and the 
process of moving the driving part PI (step S3204), are 
repeated until the posture <t> of the driving part PI assumes 
a final posture (until YES is judged at step S2205) . 
[0240] 

15 FIG. 63 is a flow diagram illustrating a non-contact 

posture retrieving routine, which is to be executed by step 
S2202 of the cam-relation retrieving routine of FIG. 62, 
for retrieving the non-contact posture of the driven part 
P2 . 

20 As shown in FIG. 63, first of all, at step S2301, 

the current posture (J) of the driven part P2 is set to (J) 
0 so that the initial value 0 is set for the count value 

n of a counter . 

[0241] 

25 At step S2302, it is discriminated whether or not 

the driven part PI and the driven part P2 interfere with 
each other; if no interference, the current posture </> is 
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regarded as a non-contact posture (step S2315). 

If it is judged at step S2302 that an interference 
has occurred, the procedure goes to step S2303 where the 
count value n is increased by 1, and then forward to step 
5 S2304 where <]) o + n A <i> is set as the posture <J) of the driven 
part P2, whereupon the procedure goes forward to step S2305 
where it is discriminated again whether or not interference 
is still present. If interference is still present, the 
procedure goes to step S2306 where ^(j-nA </> is set as the 

10 posture </> of the driven part P2, whereupon the procedure 
goes forward to step S2307 where it is discriminated again 
whether or not interference is still present. If 
interference is still present, the procedure goes to step 
S2308 where it is discriminated whether or not the count 

15 value n is the upper limit of n. If it is the upper limit 
of n, it is judged that the retrieval has been unsuccessful 
(step S2309). If the count value n has not yet reached 
the upper limit, the procedure returns to step S2303 where 
the count value n is increased by 1. In the same manner, 

20 an interference check is performed. 
[0242] 

If it is judged at step S2305 that no interference 
occurs, the procedure goes to step S2310 where <i> is 
decreased by A & , and then forward to step S2311 where 
25 A <l) is divided by a suitable integer N and is set to a 
value smaller than previous. 

Then, while <i> is increased by A $ , which has been 
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set to the smaller value as mentioned above (step S2313) , 
it is discriminated whether or not an interference is 
present (step S2312) . If a change has occurred from the 
interfered status to the no- inter fered status, the 
5 procedure goes to step S2314 where it is discriminated 
whether or not retrieval is performed to a predetermined 
degree of precision. If the degree of precision is 
inadequate, the procedure returns to step S2310 where A 
<l> is subtracted from </> , and then forward to step s2311 
10 where a further smaller value is set as A <J) , whereupon 
an interference check is performed while <i> is increased 
intermittently by a pitch of a further smaller value A 
(]) (steps S2312 and S2313) . 
[0243] 

15 Thus when retrieval is performed to a predetermined 

degree of precision (step S2314), a non-contact posture 
is thereby determined (step S2315) . 

Also when it is judged at step S2307 that no 
interference is present, the same processes as those of 

20 steps S2310 through S2314 so that a non-contact posture 
of the driven part P2 . When it is judged at step S2307 
that no interference is present, <!> is increased by A </> 
in a step corresponding to step S2310, and <]> is decreased 
by A (J) in a step corresponding to step S2313. 

25 [0244] 

FIG. 64 are flow diagrams illustrating a non-contact 
posture retrieving routine, which is to be executed by step 
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S2202 of the cam-relation retrieving routine of FIG. 62, 
for retrieving a non-contact posture of the driven part. 
The routine of FIG. 64 is a routine to be executed when 
gravity or resiliency of a spring acts on the driven part. 
5 The direction in which gravity or resiliency of a spring 
acts on the driven part is previously set; in FIG. 64, a 
force is exerted in a negative direction. 
[0245] 

In the routine of FIG. 64, first of all, at step S2401, 
10 the current posture </> of the driven part is set to </> $, 
and the count value n of a counter is set to an initial 
value 0. 

At step S2402, it is discriminated whether or not 
the driving part and the driven part currently interfere 

15 with each other. If an interference has occurred, the 
procedure goes to step S2403 where the count value n is 
increased by 1. In this case, since the interference of 
the driven part is due to the current posture change of 
the driving part, the posture of the driven part is changed 

20 against gravity or the resiliency of a spring (steps S2404 
through s2407) . After the posture being devoid of 
interference is found, A ^ is subtracted from <l> to 
temporarily restore the interfered posture (step S2408) . 
The processes of steps S2403 through S2408 of FIG. 64 

25 respectively correspond to those of steps S2303 through 
S2305, S2308, S2309, and S2310 of FIG. 63. 
[0246] 
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Otherwise if it is judged at step S2402 that no 
interference is present, the procedure goes to step S2409 
where the count value n is increased by 1. In this case, 
since the posture of the driven part has changed off the 
5 interference is due to the current posture change of the 
driving part, the action of gravity or resiliency of a spring 
is simulated to fine a status in which the driven part has 
interfered the driving part (steps S2410 through S2413) . 
The processes of steps S2409 through S2413 of FIG. 64 
10 respectively correspond to those of steps S2303 and S2306 
through S2309 of FIG. 63. 
[0247] 

When the procedure goes forward to step S2414 from 
step S2408 or S2411, the bare interference has occurred 

15 in A <p . Consequently, by dividing A </> by a suitable 

integer N and setting the result of division as A (J) so 
that A (f) issettoa smaller value asprevious. After that, 
a non-interference posture is retrieved while </> is 
increased intermittently by. a pitch of A <J) (steps S2415 

20 and S2416) . 
[0248] 

At step S2417, it is discriminated whether retrieval 
has been performed to a predetermined degree of precision. 
If the resulting degree of precision is still inadequate, 
25 the procedure goes to step S2408 where A & is subtracted 
from (J) to restore the interfered posture, and then forward 
to step S2414 where A <p is divided by an integer N and 
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the result of division is set as A <]> so that A </> is set 
to a smaller value as previous for repeating the retrieval . 

Thus when the retrieval has been performed to a 
predetermined degree of precision (step S2414), a 
5 non-contact position is determined (step S2418). The 
processes of steps S2408, S2414 through S2418 of FIG, 64 
respectively correspond to those of steps S2310 through 
S2315 of FIG. 63. 
[0249] 

10 It is thereby possible to determine the cam 

relationship, irrespective of whether or not gravity or 

the resiliency of a spring acts in the driven part. 

FIGS. 65(A) through 65(C) are diagrams illustrating 

how to set a groove-pin relationship between a groove P10 
15 formed in a driving member PI and a pin P20 projecting from 

a driven member P2 and inserted in the groove P10. FIGS. 

65(B) and 65(C) are fragmentary, enlarged views of FIG. 

65 (A) . 

[0250] 

20 When the groove-pin relationship of FIGS. 65(A) and 

65 (B) is set, the pin P20 is normally in contact with the 
groove P10 . Therefore, a non-interference position cannot 
be obtained, and such groove-pin relationship is difficult 
to obtain using the above-mentioned cam-relation 

25 retrieving method. 

Consequently, as shown in FIG. 65 (C) , for obtaining 
the groove-pin relationship, a very small cylindrical tube 
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P21 having a radius r is temporarily attached centrally 
to the pin P20, and a distance d between the very small 
cylindrical tube P21 and the groove P10 is measured . Namely, 
at steps S2302, S2305, S2307 and S2312 of FIG. 63, 
5 discrimination on "d<R-r?" is performed instead of 

discrimination on "interference is present?", so that the 

groove-pin relationship can be retrieved. 

[0251] 

How to simulate various kinds of mechanisms (such 
10 as roller, ratchet, motor, sensor) on the 3Dmodel simulator 
30 of the present embodiment will now be described with 
reference to FIGS . 66 through 82. 

FIG. 66 is a flow diagram illustrating a link posture 
varying routine if the mechanism includes gears and a roller 
15 as links. The routine of FIG. 66 corresponds to a link 
posture varying subroutine (FIG. 47) to be executed by the 
above-mentioned motor processing routine (step S1107 of 
FIG. 46) . FIG. 67 is a flow diagram illustrating a joint 
value moving subroutine, and FIG. 68 is a flow diagram 
20 illustrating a joint value initializing subroutine. The 
link(s) will hereinafter also called "the joint (s)". 
[0252] 

Here, a roller is one of various function of a gear. 
In the following routine, as shown in flow diagram of FIGS . 
25 66 through 68, by reflectively calling and executing the 
joint value moving subroutine of FIG. 67, follower joints 
(passive joints) , which move depending on the movement of 
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a current joint is moved. During this moving, if one of 
the follower joints has reached a restricting value, the 
joint value initializing subroutine of FIG. 68 is 
reflectively called and executed in order that the joint 
5 value restores a preset initial value. 
[0253] 

As shown in FIG. 66, if this routine is called in 
response to the link posture movement (e.g., the posture 
movement of the motor link), the joint value moving 

10 subroutine of FIG. 67 is called and executed in order to 
move the current joint in response to the movement of the 
motor link (step S2501) . Then it is discriminated whether 
or not a return value from the joint value moving subroutine 
at step S2501 is "TRUE" (step S2502) . If the return value 

15 is "TRUE" (YES route), the joint value initializing 

subroutine of FIG. 68 is called or executed for the current 
joint (step S2503) , whereupon the procedure of this routine 
is terminated. If it is judged at step S2502 that the return 
value is not "TRUE" (NO route) , the procedure of this routine 

20 is terminated without advancing to another step. 
[0254] 

In the joint value moving subroutine, as shown in 
FIG. 67, after the joint value moving is performed (step 
S2511) , it is discriminated whether or not the joint value 
25 has reached a restricting value (step S2512) . If it has 
reached the restricting value (YES route) , "TRUE" is output 
as the return value (step S2513) . Otherwise if it has not 
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reached the restricting value (NO route), it is 
discriminated whether or not an unprocessed follower joint 
is present (step S2514) . If no unprocessed follower joint 
is present (NO route) , "FALSE" is output as the return value 
5 (step S2515) . 
[0255] 

Otherwise if it is judged at step S2514 that an 
unprocessed follower joint is present (YES route) , the 
amount of movement of the follower joint is calculated from 

10 the gear, cam relationship (step S2516) , whereupon the 
joint value moving subroutine is called and executed for 
the follower joint (step S2517) . Then it is discriminated 
whether or not the return value from the subroutine executed 
at the step S2517 is "TRUE" (step S2518). If the return 

15 value is "TRUE" (YES route) , "TRUE" is output as the return 
value (step S2519) . Otherwise if it is judged that the 
return value is not "TRUE" (NO route), the procedure returns 
to step S2514. 
[0256] 

20 In the joint value initializing subroutine, as shown 

in FIG. 68, after the previous joint value is set as the 
joint value (step S2520), it is discriminated whether or 
not an unprocessed follower joint is present (step S2521) . 
If no unprocessed follower joint is present (NO route), 

25 the procedure returns to the step where this joint value 
initializing subroutine was called. Otherwise if an 
unprocessed follower joint is present (YES route), the 
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joint value initializing subroutine is called and executed 
for the follower joint (step S2522), whereupon the 
procedure returns to step S2521. 
[0257] 

5 FIGS. 69(A) through 69(C) are diagrams illustrating 

the motions of the gears and roller. 

Here, as shown in FIG. 69 (A) , when a drum, as a driving 
part, is rotated, the driving force is transmitted to two 
sliders 1 and 2, as follower parts (passive parts); a 
10 mechanism for moving these sliders 1 and 2 horizontally 
will now be described. 
[0258] 

Assume that the mechanism of FIG. 69(A) is composed 
of gears, as shown in FIG. 69(B), when the left end of the 

15 slider 1 hits a left wall surface in response to the 

counterclockwise rotation of the drum (namely, when the 
slider 1 has reached a restricting value) , the drum or slider 
2 will make no further movement. 

In the mechanism of FIG. 69 (A) , assume that the gear 

20 between the drum and the slider 1 is a roller which allows 
a slip. Even if the slider 1 has become unable to move 
as reached a restricting value, as shown in FIG. 69(C), 
the drum continues rotating counterclockwise while the 
slider 2 is still horizontally moving leftwardly. 

25 [0259] 

FIG. 70 is a flow diagram illustrating a modified 
portion of the joint moving subroutine if the mechanism 
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includes a roller as a link. 

In simulating this roller on the 3D model simulator 
30, as shown in FIG . 70, step S2530 of discriminating whether 
or not the follower joint is a roller is added between step 
5 S2518 and step S2519 of FIG. 67. If it is a roller (YES 
route), the procedure returns to step S2514. Otherwise 
if it is not a roller (NO route) , the procedure goes forward 
to step S2519. Namely, it is checked whether or not the 
follower joint tobeprocessedis a roller; if it is a roller, 
10 the restricting value process is performed, and then 

restricting value information is prevented from flowing 
upstream of the follower joint. 
[0260] 

How to simulate a ratchet on the 3D model simulator 
15 30 will now be described in brief. 

The ratchet, like a pulley or a ratchet trench of 
a bicycle, transmits a power force in a direction designated 
by the user, and does not transmit a driving force in a 
direction opposite to the designated direction. 
20 [0261] 

The ratchet is simulated on the 3D model simulator 
30 in the same manner as the clutch simulating method 
described above in connection with FIG. 47. If the 
mechanism to be simulated has a ratchet; when the direction 
25 of moving the driving part being a ratchet is the user's 
designated direction, the driving force is transmitted to 
execute the moving process (joint value moving process) 
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for the passive part. And otherwise when it is a direction 
opposite to the user's designated direction, the driving 
force is not transmitted. 
[0262] 

5 FIGS. 71(A) through 71(F) are diagrams illustrating 

an elevator as a mechanism model, and a tree- structure link 
constituting the elevator, FIG. 72 is a diagram showing 
a parent-child relationship changeover information to be 
assigned to the individual links, and FIG. 73 is a flow 

1 0 diagram illustrating a parent changeover check subroutine . 

The individual links (joints) constituting a 
mechanism model are generally connected in a tree form. 
When an arbitrary link is moved children of the link are 
all moved in the same way. In this data structure, it is 

15 difficult to express an elevator of FIGS. 71(A) through 
71 (F) . Consequently, in the present embodiment, like the 
case of clutch, a function of changing over the parent by 
any condition (e.g., a third joint value) is added. 
[0263] 

20 The elevator of FIGS. 71(A) through 71(C) moves a 

horizontally movable car C between two bases B, B of 
different heights using a vertically movable table T. The 
elevator whose posture is shown in FIG. 71 (A) is expressed 
in a tree structure in which the car C and the table T are 

25 children of the base B as shown in FIG. 71 (D) . The elevator 
whose posture is shown in FIG. 71 (B) is expressed in a three 
structure in which the car C is a child of the base B while 
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the table T is a child of the base B as shown in FIG. 71 (E) . 
And the elevator whose posture is shown in FIG. 71(C) is 
expressed in a three structure in which the car C and the 
table T are children of the base B as shown in FIG. 71 (F) . 
5 [0264] 

For simulating a mechanism (such as an elevator) in 
which a parent-child relationship is changed over, 
parent-child-relationship changeover information such as 
shown in FIG. 72 is previously assigned to the individual 

10 link (joint), and subsequently in simulation on the 3D model 
simulator 30 as the joint value is changed (after the joint 
value is moved) , the parent is recalculated and changed 
over, based on the information of FIG. 72, for a particular 
child part that is possibly influenced in parent-child 

15 relationship due to the change of the joint value. 
[0265] 

For example, after the joint value movement is 
performed at step S2511 of FIG. 67, it is discriminated 
whether or not a parent-child changeover part is present. 
20 If a parent-child changeover part is present, a parent 
changeover check subroutine of FIG. 73 is called and 
executed . 

As shown in FIG. 73, in the parent changeover check 
subroutine, first of all, it is discriminated whether or 
25 not an unprocessed parent part candidate is present (step 
S2531). If no unprocessed parent part candidate is 
present (NO route), it is discriminated whether or not an 
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processed, parent changeover condition is present (step 

S2532) . 

[0266] 

If such an unprocessed condition is present (YES route 
5 of step S2532), it is discriminated whether or not the 
condition is satisfied (step S2533) . If it is satisfied 
(YES route) , he procedure returns to step S2532 . Otherwise 
if it is not satisfied (NO route), the procedure return 
to step S2531. And if it is judged at step S2532 that no 
10 unprocessed condition is present (NO route), parent 
changeover is performed (step S2534), whereupon the 
processes of this subroutine are terminated. 
[0267] 

How to simulate a relative clutch on the 3D model 
15 simulator 30 will now be described in brief. 

A clutch plays a key role in determining the on/off 
status of power transmission of a gear-cam relationship 
by any condition (e.g., a joint value of a third joint) . 
A relative clutch plays a key role in determining the on/off 
20 status of power transmission of a gear-cam relationship 
by relative positions of arbitrary two parts, realizing 
a placement mechanism using the parent-child changeover. 
[0268] 

In ordinary simulation, it is checked as to "whether 
25 the position of a clutch part is in the on position" (step 
S1204 of FIG. 47) . In relative clutch simulation, it is 
checked as to "whether a part B is in the on position with 
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respect to (as viewed from) a part A" with all the remaining 
processes being identical with those of ordinary 
simulation . 
[0269] 

5 The position of the part B as viewed from the part 

a can be obtained from Ra" 1 ( p a~ p b) where is a matrix 
angularly moved from the absolute coordinates of local 
coordinates of the part A, and and Pg are the respective 
positions of the parts A and B as viewed from the absolute 

10 coordinates. 

How to simulate a DC motor on the 3D model simulator 
30 will now be described with reference to FIGS- 7 4 and 
75. FIG. 74 is a flow diagram illustrating the simulation 
procedure of a DC motor, and FIG. 75 is a table showing 

15 input values of the DC motor and motor instruction values 
in correspondence with one another. 
[0270] 

For simulating a DC motor, a correlation between input 
values of the DC motor and motor instructing values are 

20 previously registered as a table such as shown in FIG. 75. 
This table is similar to the table described above in 
connection with FIG. 26, except that correlation of values 
(actuator instructing signals) to be input to two ports 
(port numbers 11, 12) of the DC motor with target speeds 

25 (deg/sec) and settling times (msec) . 
[0271] 

With the table of FIG. 75, if 0 and 1 are input to 
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the ports 11/ 12, respectively, the target speed +100 
deg/sec and the settling time 500 sec are output as motor 
instructing values. And if 0 and 1 are input to the ports 
11, 12, respectively, the target speed -100 deg/sec and 
5 the settling time 500 sec are output as motor instructing 
values . 
[0272] 

This table is set and registered, whereupon 
simulation of the DC motor is performed on the 3D model 

10 simulator 30 in accordance to the procedure of FIG. 74. 
Namely, actuator instructing signals from the embedded 
software developing section 4 0 are recognized as respective 
status input of the port numbers (step S2541), and then 
the input values are converted into motor instructing 

15 values (target speed and settling time) (step S2542). 
[0273] 

Then, the already calculated current simulation time 
Ts ( = At) is input (step S2543) to calculate an angle of 
rotation of the DC motor from the current simulation time 

20 Ts {= At) (step S2544) . In this specification, the term 
"rotation" is defined to read on not only "moving through 
360 degrees or more about the axis" but also "turning through 
less than 360 degrees about the axis" . At that time, though 
the angle of rotation can be calculated as by (the target 

25 speed X the simulation time) , it can alternatively 

calculated using the equation (4) as mentioned above, if 
the total simulation time from the inputting of the motor 
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instructing values is equal to or less than the settling 
time. Subsequently the joint values of all the joints 
(links ) connected to the DC motor are calculated to complete 
the processes (step S2545). 
5 [0274] 

How to simulate a stepping motor on the 3D model 
simulator 30 will now be described with reference to FIGS . 
76 through 78. FIG. 76 is a flow diagram illustrating the 
simulation procedure of a stepping motor, FIG. 77 is a 
10 diagram illustrating an accelerating pattern of the 

stepping motor, and FIG. 78 is a flow diagram illustrating 

a pulse counts calculating subroutine. 

[0275] 

For simulating a stepping motor, as shown in FIG. 

15 77, an acceleration pattern Th (N) of the stepping motor 
is in advance registered in terms of ti, which is a time 
interval of an i- th pulse from the start of the acceleration . 

With this acceleration pattern Th (N) registered, 
simulation of the stepping motor is performed on the 3D 

20 model simulator 30 in accordance with the procedure of FIG. 
7 6 . Namely, from the embedded software developing section 
40, not only the motor instructing value (target speed) , 
as an actor instructing signal) but also the already 
calculated current simulation time Ts (= At) is input 

25 (steps S2551 and S2552) to obtain the number of pulses output 
to the stepping motor within the current simulation time 
Ts (= At) in accordance with the pulse counts calculating 
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subroutine of FIG. 78 (step S2553) . 
[0276] 

Then based on the pulse counts calculated at step 
S2553, the angle of rotation of the stepping motor is 
5 calculated (step S2554), and the joint values of all the 
joints (links) connected to the stepping motor is 
calculated to complete the processes (step S2555) . 

In the pulse count calculating subroutine, as shown 
in FIG . 78, first of all, the number of accumulated pulses 

10 is set as a pulse count p, and 0 is set as the simulation 
time t (step S2561) , and t + Th(p) is set as t (step S2562) , 
whereupon it is discriminated whether or not the resultant 
time t is smaller than the simulation time Ts (step S2563) 
If t<Ts (YES route) , p+1 is set as p (step S2564) , and the 

15 procedure returns to step S2562) . If the simulation time 
t reaches Ts, this pulse counts calculating subroutine is 
terminated, and as a result, the pulse counts p is output 
as the result of calculation. 
[0277] 

20 How to simulate an AC motor on the 3D model simulator 

30 will now be described with reference to FIG. 79. FIG. 
79 is a flow diagram illustrating the simulation procedure 
of an AC motor. 

As shown in FIG. 79, for simulating a stepping motor 

25 on the 3D simulator 30, first all, a motor ins tructing value 
(target speed) as an actuator instructing signal (step 
S2571) , a settling time corresponding to the target speed 
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(the correlation is previously registered) (steps S2571 
and 2572), and the already calculated current simulation 
time Ts (= At) are input (steps S2571, S2572 and S2573), 
whereupon the angle of rotation of the AC motor for the 

5 current simulation time Ts (= At) is calculated (step 
S2574) . 
[0278] 

At that time, basically the angle of rotation can 
be calculated by (the target speed X the simulation time) , 

10 but acceleration is considered in calculation if the total 
simulation time from the inputting of the motor instructing 
value is equal to or less than the settling time. Then 
the joint values of all the joints (links) connected to 
the AC motor are calculated to complete the processes (step 

15 S2575) . 
[0279] 

How to simulate a micro switch on the 3D model 
simulator 30 will now be described with reference to FIG. 
80. FIG. 80 is a flow diagram illustrating the simulation 

20 procedure of a micro switch. 

As shown in FIG. 80, for simulating a micro switch 
on the 3D model simulator 30, first of all, the joint value 
of the joint, with the micro switch set as a sensor, and 
the correlation (table) between the joint value and the 

25 sensor value are input (steps S2581 and S2582) , whereupon 
the sensor value (on/off) is judged based on the joint value 
and the table (step S2583) and is output to the embedded 
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software developing section 40 (step S2584). 
[0280] 

How to simulate an encoder on 3D model simulator 30 
will now be described with reference to FIG . 81. FIG. 81 
5 is a flow diagram illustrating the simulation procedure 
of an encoder. 

As shown in FIG. 81, for simulating an encoder on 
the 3D model simulator 30, first of all, the joint value 
of the joint, with the encoder as a sensor , and the resolution 
10 of the encoder and the joint value at the encoder's origin 
are input (steps S2591 and S2592), whereupon a waveform 
corresponding to the joint value is calculated to thereby 
calculate a sensor value corresponding to the joint value 
(step S2593) . Finally the calculated sensor value is 
15 output to the embedded software developing section 40 (step 
S2594) . 
[0281] 

How to simulate a potentiometer on the 3D model 
simulator 30 will now be described with reference to FIG. 

20 82. FIG. 82 is a flow diagram illustrating the simulation 
procedure of a potentiometer. 

As shown in FIG. 82, for simulating a potentiometer 
on 3D model simulator 30, first of all, the joint value 
of a joint, with the potentiometer as a sensor, and the 

25 correlation (table) between the joint value and the sensor 
value are input (steps S2601 and 2 6 02) , whereupon the sensor 
value is calculated based on the joint value and the table 
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(step S2603). Finally the calculated sensor value is 
output to the embedded software developing section 40 (step 
S2604) . 

[0282] 

5 Thus according to the support system 10 of the 

illustrated embodiments of the present invention, by taking 
the three-dimensional real-time simulator 30 as the pivot 
section, it is possible not only to progress the developing 
the embedded software (control program) separately 

10 (concurrently) of the designing the mechanism , without 
making a trial product of the mechanism. Namely, it is 
possible to concurrently perform designing o f the mechani sm 
by the mechanism designing section 20 and developing of 
the embedded software by the embedded software developing 

15 section 40 so that efficient developing of the embedded 
software and reduction of the developing period (term) and 
the number of steps can be achieved. 
[0283] 

At that time, it is possible to efficiently develop 
20 the embedded software in the absence of a trial product 
of the mechanism, by combining the task control describing 
method, which is according to the status- transit ion di a gram 
or table, with the three-dimensional real-time simulator 
30 . 

25 Further, with the mechanism designing section 20 

operatively connected with the three-dimensional 
real-time simulator 30, if a movable part of the 
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three-dimensional-mechanism model is moved on the 
simulation without manufacturing a trial product, it is 
possible to perform the designing of the mechanism while 
checking whether the prospective mechanism could make an 
5 intended motion without any risk that the individual parts 
would inadvertently contact each other. As a result, the 
designer can find any problem of design as early as possible 
and hence can make rearrangement of parts or necessary 
changes in view of movable parts, requiring only a shortened 
10 period (term) of development of products and reducing the 
cost of production. 
[0284] 

Furthermore, given that the microcomputer chip 42 
and the three-dimensional real-time simulator 30 are 

15 operatively coupled, it is possible to debug a mechanism 
control program without physically manufacturing a 
mechanism, which would be some contribution to reducing 
the developing period (term) of embedded software and hence 
providing inexpensive products. 

20 The present invention should by no means be limited 

to the illustrated examples, and various other changes or 
modifications may be suggested without departing from the 
gist of the invention. 
[0285] 

25 [Effect of the Invention] 

As described above, according to a support system 
(claims 1 to 10) and a computer-readable recording medium 
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in which a support program is recorded (claims 11 to 18) , 
of the present invention, with a three-dimensional 
mechanism model simulation section at its center, 
development of an embedded software can be advanced 
5 independently of mechanism designing, without need to make 
a mechanism trial product . That is, designing of mechanism 
and development of an embedded software for controlling 
the mechanism can be performed concurrently, making 
development of the embedded software efficient, and 
10 achieving both shortening of development period and 
reduction of man-hour. 
[Brief Description of the Drawings] 
[FIG, 1] 

FIG.l is a block diagram showing a support system 
15 according to a first embodiment of the present invention. 
[FIG. 2] 

FIG. 2 is a diagram showing the architecture of a 
support program that is recorded in a computer-readable 
recording medium of the present embodiment. 
20 [FIG. 3] 

FIG. 3 is a schematic, perspective view of a computer 
system in which the support system of the first embodiment 
can be architected. 

[FIG. 4] 

25 FIG. 4 is a block diagram showing hardware of a 

computer system in which the support system of the first 
embodiment can be architected. 



140 



[FIG. 5] 

FIG. 5 is a block diagram showing a main portion of 
the support system of the first embodiment. 
[FIG. 6] 

5 FIGS. 6(A) and6(B) show respect ive specif ic examples 

of a figure data file and an assembly data file which are 
to be transferred from a mechanism designing section to 
a three-dimensional real-time simulator (hereinafter also 
called the simulator) . 
10 [FIG. 7] 

FIG. 7 is a block diagram showing a main portion (a 
three-dimensional real-time simulator, a 

status- trans it ion diagram or table creating section, and 
a second interface section) of the support system of the 
15 first embodiment. 

[FIG. 8] 

FIG . 8 shows a displayed example of status -trans it ion 
diagram and table. 
[FIG. 9] 

2 0 FIG . 9 shows a displayed example of status- trans it ion 

diagram and table. 
[FIG. 10] 

FIGS. 10(A) through 10(C) are a timing diagram 
illustrating a multi-task. 
25 [FIG. 11] 

FIGS. 11(A) and 11(B) illustrate how to schedule a 
task with priority. 
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[FIG. 12] 

FIGS. 12(A) through 12(D) are a timing diagram 
illustrating a synchroni zation process using a synchronous 
task . 
5 [FIG. 13] 

FIG. 13 is a block diagram illustrating a 
synchronization process using a synchronous task of the 
first embodiment . 

[FIG. 14] 

10 FIG. 14 is a flow di a gram il lust rat ing the synchronous 

process . 

[FIG. 15] 

FIG. 15 a diagram showing a displayed example in a 
logic analyzer of the first embodiment. 
15 [FIG. 16] 

FIG. 16 is a flow diagram illustrating the procedure 
of a whole simulating process including a process by the 
logic analyzer of the first embodiment. 

[FIG. 17] 

20 FIG. 17 is a concept diagram illustrating the mode 

of operation of a three-dimensional model simulator of the 
support system of the first embodiment. 
[FIG. 18] 

FIG. 18 is a diagram of a three-dimensional real-time 
25 simulator, illustrating how to define a sensor and a motor . 
[FIG. 19] 

FIG. 19isa diagram illustrating a simulating proces s 
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according to the three-dimensional real-time simulator of 
the first embodiment. 
[FIG. 20] 

FIG. 20 is a timing diagram illustrating the operating 
5 timing between the three-dimensional real-time simulator 
and an embedded software developing section (synchronous 
task) according to the first embodiment. 
[FIG. 21] 

FIG. 21 is a flow diagram illustrating the simulation 
10 procedure according to the three-dimensional real-time 
simulator of the first embodiment. 
[FIG. 22] 

FIG. 22 is a flow diagram illustrating a partial flow 
to be substituted for apartial flowof simulation procedure 
15 of the simulator of FIG. 21. 
[FIG. 23] 

FIG. 23 is a perspective diagram showing one example 
of motor link to illustrate how to select a link tobe defined 
as a motor (motor link) . 
20 [FIG. 24] 

FIGS. 24(A) and 24(B) are perspective diagrams 
showing one example of a sensor link to illustrate how to 
select a link to be defined as a sensor (sensor link) . 

[FIG. 25] 

25 FIGS. 25(A) and 25(B) are perspective diagrams 

showing another example of a sensor link to illustrate how 
to select a link to be defined as a sensor (sensor link) . 
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[FIG. 26] 

FIG. 26 is a diagram illustrating various kinds of 
motors . 

[FIG. 27] 

FIG. 27 is a graph showing an initial change of 
rotation rate of a motor when the motor is regarded as a 
primary delay system. 

[FIG. 28] 

FIG. 28 is a flow diagram illustrating a motor driving 
process, with a primary delay considered, in the 
three-dimensional real-time simulator of the first 
embodiment . 

[FIG. 29] 

FIG. 29 is a diagram illustrating how to define a 
sensor using an interference check. 
[FIG. 30] 

FIG. 30 is a perspective diagram illustrating how 
to define a sensor using an interference check. 

[FIG. 31] FIGS. 31(A) through 31(C) are perspective 
diagrams illustrating how to define a sensor using an 
interference check . 

[FIG. 32] 

FIG. 32 is a timing diagram illustrating various 
signals to be transferred between the three-dimensional 
real-time simulator and the embedded software developing 
section to establish synchronization in the first 
embodiment . 
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[FIG. 33] 

FIG. 33isaflow diagram illustrating how to establish 
synchronization in operation between the 

three-dimensional real-time simulator and the embedded 
5 software developing section. 
[FIG. 34] 

FIG. 34 is a flow diagram illustrating the processing 
of the three-dimensional real-time simulator to realize 
synchronization in operation between the 
10 three-dimensional real-time simulator and the embedded 
software developing section. 
[FIG. 35] 

FIGS. 35(A) and 35(B) are diagrams illustrating how 
to evaluate the possibility of interference in the first 
15 embodiment. 

[FIG. 36] 

FIGS. 36(A) through 36(C) are graphs showing various 
kinds of relationships between the inter-part distance and 
the simulation distance. 
20 [FIG. 37] 

FIGS. 37(A) and 37(B) are diagrams illustrating how 
to divide parts into groups. 

[FIG. 38] 

FIGS. 38(A) through 38(D) are diagrams illustrating 
25 how to divide parts into groups (grouping) with a plurality 
of motor links defined in a single 
three-dimensional-mechanism model . 
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[FIG. 39] 

FIG. 39 is a diagram illustrating how to divide the 
grouped parts into new groups (regrouping) . 
[FIG. 40] 

5 FIG. 40 is a flow diagram illustrating a routine of 

dividing a plurality of links into a group of those affected 
in posture by a movement of the motor link and a group of 
those free of being affected in posture by a movement of 
the motor link. 
10 [FIG. 41] 

FIG. 41 is a flow diagram illustrating a routine of 
retrieval of FIG. 40. 
[FIG. 42] 

FIG. 42 is a perspective diagram of a link mechanism 
15 model for explaining operation of the routines of FIGS. 
40 and 41. 

[FIG. 43] 

FIG. 43 is a diagram illustrating a data structure 
of the link mechanism model of FIG. 42. 
20 [FIG. 44] 

FIGS. 44 (A) through 44 (D) are diagrams specifically 
illustrating how to extract combinations of links for 
obtaining inter-link distances during simulation in the 
group of the links affected in posture by a movement of 
25 the motor link. 

[FIG. 45] 

FIG. 45 is a flow diagram illustrating the whole 
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simulation procedure by a three-dimensional real-time 
simulator according to a second embodiment of the present 
invention . 

[FIG. 46] 

5 FIG. 46 is a flow diagram illustrating a motor 

processing routine . 
[FIG. 47] 

FIG. 47 is a flow diagram illustrating a link posture 
varying subroutine . 
10 [FIG. 48] 

FIG. 48 is a flow diagram illustrating a joint 
malfunction processing routine. 

[FIG. 49] 

FIG. 49 is a flow diagram illustrating a sensor 
15 processing routine. 

[FIG. 50] 

FIG. 50 is a flow diagram illustrating an on/off sensor 
processing routine . 
[FIG. 51] 

20 FIG. 51 is a flow diagram illustrating a sensor 

performance inferiority processing routine. 
[FIG. 52] 

FIG. 52 is a flow diagram illustrating an estimated 
output value change processing routine by chattering. 
25 [FIG. 53] 

FIG. 53 is a graph showing one example of output 
waveform with respect to the variation (e.g., angle) of 
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an encoder. 

[FIG. 54] 

FIGS. 54(A) through 54(E) are diagrams showing 
various output waveforms of an encoder. 
5 [FIG. 55] 

FIG. 55 is a flow diagram illustrating an output 
processing routine of an encoder. 

[FIG. 56] 

FIG. 56 is a flow diagram illustrating an encoder 
10 processing routine. 

[FIG. 57] 

FIG. 57 is a diagram illustrating one example of 
function value of a potentiometer. 
[FIG. 58] 

15 FIG. 58 is a flow diagram illustrating a potentiometer 

preprocessing routine . 
[FIG. 59] 

FIG. 59 is a flow diagram illustrating a 
inter-simulation distance determination processing 
20 routine. 

[FIG. 60] 

FIGS. 60(A) and 60(B) are diagrams illustrating how 
to retrieve a joint movement range by an interference check . 
[FIG. 61] 

25 FIGS. 61(A) through 61(C) are diagrams illustrating 

how to retrieve a cam relation by an interference check. 
[FIG. 62] 
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FIG. 62 is a flow diagram illustrating a cam relation 
retrieving routine by an interference check. 
[FIG. 63] 

FIG. 63 is a flow diagram illustrating a driven-part 
5 non-contact posture retrieving routine. 
[FIG. 64] 

FIG. 64 is a flow diagram illustrating a driven-part 
non-contact posture retrieving routine. 
[FIG. 65] 

10 FIGS. 65(A) through 65(C) are diagrams illustrating 

how to set a groove -pin relationship between a groove formed 
in a driving member and a pin pro j ecting from a driven member 
and inserted in the groove. 
[FIG. 66] 

15 FIG. 66 is a flow diagram illustrating a link posture 

varying routine if the mechanism includes gears and a roller 
as links . 

[FIG. 67] 

FIG. 67 is a flow diagram illustrating a joint value 
20 moving subroutine. 

[FIG. 68] 

FIG. 68 is a flow diagram illustrating a joint value 
initializing subroutine. 
[FIG. 69] 

25 FIGS. 69(A) through 69(C) are diagrams illustrating 

the motions of the gears and roller. 
[FIG. 70] 
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FIG. 70 is a flow diagram illustrating a modified 
portion of the joint moving subroutine if the mechanism 
includes a roller as a link. 

[FIG. 71] 

5 FIGS. 71(A) through 71(F) are diagrams illustrating 

an elevator as a mechanism model , and a tree- structure link 
constituting the elevator. 
[FIG. 72] 

FIG. 72 is a diagram showing a parent-child 
10 relationship changeover information to be assigned to the 
individual links. 
[FIG. 73] 

FIG. 73 is a flow diagram illustrating a parent 
changeover check subroutine. 
15 [FIG. 74] 

FIG. 74 is a flow diagram illustrating the simulation 
procedure of a DC motor . 
[FIG. 75] 

FIG. 75 is a table showing input values of the DC 
20 motor and motor instruction values in correspondence with 
one another . 

[FIG. 76] 

FIG. 76 is a flow diagram illustrating the simulation 
procedure of a stepping motor. 
25 [FIG. 77] 

FIG. 77 is a diagram illustrating an accelerating 
pattern of the stepping motor. 
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[FIG. 78] 

FIG. 78 is a flow diagram illustrating a pulse counts 
calculating subroutine . 
[FIG. 79] 

FIG. 79 is a flow diagram illustrating the simulation 
procedure of an AC motor. 
[FIG. 80] 

FIG. 80 is a flow diagram illustrating the simulation 
procedure of a micro switch. 
[FIG. 81] 

FIG. 81 is a flow diagram illustrating the simulation 
procedure of an encoder. 
[FIG. 82] 

FIG. 82 is a flow diagram illustrating the simulation 
procedure of a potentiometer. 

[Description of reference numerals] 
10 Support system 

20 Mechanism designing section (mechanism 
designing section, appearance design/ three-dimensional 
CAD system) 

30 Three-dimensional real-time simulation device 
(three-dimensional mechanism model simulation section, 
three-dimensional model simulator) 

31 Simulation section 

32 Interface section 

40 Embedded software developing section 

41 Status- transition diagram or table 
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creating/editing device ( status- transit ion diagram or 
table creating/editing section) 

411 Task control section 

412 User interface section 

5 413 Status- transition display section 

414 Interface section 

415 Internal memory 

4 2 Microcomputer chip 

43 Integrated developing environment section 
10 50 First interface section 

51, 52 Second interface section 
53 Shared memory 

100 Computer system 

101 System cabinet 

15 101a Floppy disk loading port 

101b CD-ROM loading port 

102 CRT display 
102a Display screen 

103 Keyboard 
20 104 Mouse 

210 CD-ROM 

211 Hard disk 

212 Floppy disk 
220 Bus line 

25 221 Central processing unit (CPU) 

222 RAM 

223 Hard disc controller 
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224 Floppy disk driver 

225 CD-ROM driver 

226 Mouse controller 

227 Keyboard controller 
5 228 Display controller 

229 Modem 

2 3 0 ROM 

300 Recording medium 

310 Support program 

10 311 Mechanism designing program 

312 Three-dimensional-mechanism model simulating 
program 

313 Embedded software developing program 

314 First interface program 
15 315 Second interface program 

316 Integrated developing environment program 

320 Status-transition diagram or table 
creating/editing program 
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[NAME OF DOCUMENT] ABSTRACT 
[ABSTRACT] 

[OBJECT] A support system realizing reduction of a period 
of developing an embedded software and minimization of the 
5 number of designing steps to increase the developing 
efficiency by concurrently executing the designing of a 
mechanism and the developing of the embedded software. 
[SOLVING MEANS] The system includes a 

three-dimensional-mechanism model simulating section 20, 

10 in which the mechanism is structured as a 
three-dimensional-mechanism model 30, for simulating an 
operation of the mechanism, an embedded software developing 
section 40 for developing a control program to control the 
designing and operation of the mechanism in parallel to 

15 each other, a first interface section 50 for inputting 
designing data from the mechanism designing section 20 to 
the three-dimensional-mechanism model simulating section 
30 for being dynamically reflected on the 
three-dimensional-mechanism model , and a second interface 

20 sections 51 and 52 for transferring data between the 
three-dimensional-mechanism model simulating section 30 
and the embedded software developing section 40 while 
synchronizing these two sections to each other. 
[SELECTED FIGURE] FIG.l 
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[NAME OF THE DOCUMENT] Drawings 
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3D SIMULATOR 



(A) 



(B) 



SOLID KAM_VERS I ON2_0_L I BRARY 1 
COLOR 1. OO000O 0. 660000 0. 000000 
FACET 

NORMAL 0. 000000 0. 952236 -0. 305364 
NORMAL 0. 000000 0. 952236 -0. 305364 
NORMAL 0. 000000 0. 952236 -0. 305364 
OUTER LOOP 
VERTEX 46. 667969 -54. 467480 -31. 538586 
VERTEX 46. 667969 -57. 256718 -40. 236450 
VERTEX 16. 667969 -57. 256718 -40. 236450 
ENDLOOP 

ENDFACET 

FACET 

NORMAL 0. 000000 0. 952236 -0. 305364 
NORMAL 0. 000000 0. 952236 -0. 305364 
NORMAL 0. 000000 0. 952236 -0. 305364 

OUTER LOOP 
VERTEX 16. 667969 -57. 256718 -40. 236450 
VERTEX 16. 667969 -54.467480 -31.538586 
VERTEX 46. 667969 -54. 467480 -31. 538586 

ENDLOOP 
ENDACET 



FACET 

NORMAL 0. 000000 - 0. 472754 0. 881194 
NORMAL 0. 000000 - 0. 4.72754 0. 881194 
NORMAL 0. 000000 - 0. 472754 0. 881194 
OUTER LOOP 

VERTEX 91. 667969 -77.803757 -26.071329 
VERTEX 91. 667969 -73. 224937 -23. 614828 
VERTEX 46. 667969 -73. 224937 -23. 614828 
ENDLOOP 
ENDFACET 

ENDSOLID KAM_VERSION2_0 LOBRARY1 



BEGIN SPACE 
f NO 1 

PARENT 0 # ROOT 
JOINTTYPE FREE 
END 

BEGIN "SEAT_ASSY_0_LIBRARY1" 

# NO 2 

PARENT 1 # SPACE 

RELPOS ITI ON 0. 000000 0. 000000 0: 000000 

RELATT I TUDE 1.000000 0. 000000 0.000000 0. 000000 
1. 000000 0. 000000 0. 000000 0. 000000 1. 000000 

JOINTTYPE FIXED 
END 

BEGIN " SEAT_PAN_0_L I BRARY 1 " 

# NO 3 

PARENT 2 f SEAT_ASSY_0_L I BRARY 1 
SHAPE SEAT_PAN_0_LIBRARY1. SLP 
RELPOS I TION 1. 810953 51. 404652 450. 053009 
RELATT I TUDE 1. 000000 0. 000000 0. 000000 0. 000000 

1. 000000 0. 000000 0. O000OO 0. 000000 1. 000000 
JOINTTYPE FIXED 

END 

BEGIN " KAM_VERS I ON2_0_L I BRARY 1 " 

# NO 4 

PARENT 2 S SEAT_ASSY_0_L I BRARY 1 
SHAPE KAM_VERS I ON2_0_L I BRARY1 . SLP 
RELPOS (TION 201.712204 -211.475098 811. 809509 
RELATT ITUOE 0. 104385 0. 034423 -0. 993941 0. 994522 

-0.009110 0. 104131 -0. 005471 -0. 999366 -0.035185 
JOINTTYPE FIXED 

END 



SAMPLE 



INIT/ 

MOTOR_UP=LOW; 
M0TOR_DOWN=L0W; 



[UP^SW==OFF&&DOWN_SW==OFF] 



BACK/ 

MOTOR_UP=LOW; 
MOTOR_DOWN=H I GH ; 




START/ 

MOTOR_UP=LOW; 
MOTOR_DOWN=H I GH ; 



CMDJN/ 
MOTOR_UP=L0W; 
MOTOR_DOWN=LOW; 



[SLIT_SENSOR==ON] 

[SLIT_SENSOR==ON] 



[UP_SW==ON] 




UP/ 

MOTOR_UP=LOW; 
MOTOR D0WN=HIGH; 



[SLIT_SENSOR==OFF] 
[DOWN_SW==ON] 



DOWN/ 

MOTOR_UP=LOW; 
MOTOR_DOWN=H I GH ; 




[SLIT_SENSOR==OFF] 



[FIG.9] 
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